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Da in kritischen Verkehrssituationen haufig nicht schnell 
genug und situationsgerecht auf Gefahrdungen durch Hin- 
dernisse reagiert werden kann. soil in derartigen Fallen mit- 
tels einer automatischen Kollisionsvermeidung ein koHi- 
siohsvermeidendes 6eschleunigungs>. Brems- bzw. Aus- 
weichmanoverdurchgefuhrt werden. 

Dies wird durch ein hierarchisch aufgebautes Verfahren und 
durch eine zugehdrige Vorrichtung bewerkstelligt, wobei 
sensorisch Daten des Fahrzeuges und seiner Soltbahn erfaf^t 
und daraus errrtittelte Sollsignale der Fahrzeugbahn einer 
zweiten hierarchischen Stufe einer Kollisionsvermeidungs- 
Vorrichtung zusammen mil den beispielsweise sensorisch 
erfa&ten Daten etner Hindernisbahn zugefuhrt und daruber 
die Stellgtieder der Fahrzeugregelung im Sinhe einer Kolli- 
sionsvermeidung in einer dritten- hierarchischen Stufe ange- 
St euert warden. 

Das Verfahren und die Vorrichtung eignen sich insbesonde- 
re fur StraSenfahrzeuge. 
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Beschreibung 



1. Titel 

Verfahren und Vorrichtung zur automatischen Kollisionsvermeidung fur automatisch fiihrbare Pahrzeuge. 

2. Anwendungsgebiet 

10 Die Erfindung betrifft die Erkennung von Kollisionsgefahren ffir Pahrzeuge, basierend auf sensorisch ermittel- 
ten Daten Qber das Pahrzeug, andere Verkehrsteilnehmer^ Hindemisse und Umweltbedingungen sowie die 
Berechnung kollisionsfreier Soilbahnen in Echtzeit fOr eine automatische Fahrzetigfuhriing. 

3. Zweck 

In kritischen Verkehrssituationen, in denen der Fiihrer eines Kraftfahrzeuges nicht schnetl genug und situa- 
tionsgerecht auf Gefahrdungen durch Hindernisse oder andere Verkehrsteilnehmer reagieren kann, leitet die 
automatische Kollisionsvermeidung Notfallfahrmanover ein und gibi der Fahrzeugregelung eine situationsab- 
hangige in Echtzeit berechnetekoHisionsfreie Sollbahnvor. * 

20 

4. Stand der Technik . 

In Zusammenarbeit zwischen Martin Marietta Denver Aerospace und der Carnegie Mellon University ist in 
den letzten Jahren in den USA im Rahmen des Autonomous Land Vehicle (ALV) Programms der Defence 

25 Advanced Research Projects Agency (DARPA) erfolgreich an der Entwicklung autonomer Landfahrzeuge 
gearbeitet worden. Es existieren Testfahrzeuge, die in der Lage sind, selbst^ndig in. einem Testgelande zu 
navigieren und Hindernisse zu erkennen und in ihrer Position zu bestimmen. Hierzu werden die Daten eines 
Sensors ausgewertet, der am Pahrzeug angebracht ist und die Szene vor dem Fahrzeug mittels eines Lasers 
abtastet (SPIE Vol. 727 Mobile Robots* 1 986; S. 1 10— 1 1 5; S. 261 —266). 

30 An der Universit^t der Bundeswehr MOnchen ist ein automatisch geftihrtes Fahrzeug entwickelt worden, das 
mit Geschwindigkeiten bis zu 100 km/h selbst^ndig in einer autobahnahnlichen Umgebung, d. h. ohne Gegenver- 
kehr und Kreuzungen, fahrt Die Algorithmen zur Fahrzeugfuhning basieren auf der Bestimmungder Kurven- 
kriimmung als charakterisierender GroBe fiir den Fahrbahnverlauf. Die Kurvenkrummung wird aus den Bildern 
verschiedener am Fahrzeug angebrachter Kameras, die die Gesamtszene vor dem Fahrzeug und einzelne 

35 Ausschnitte der Szene im Verlauf der Fahrbahnbegrenzung beobachten (SPIE Vol. 727 Mobile Robots, 1986; S. 
161 -168).ermittell. 

Der augenblickliche Stand der Technik erlaubt es, den Verlauf der Fahrbahn (Sollkurswinkel fur das Fahrzeug, 
Krummungsradius in Kurven) und die Position des Fahrzeuges auf der Fahrbahn sensorisch zu ermittein und das 
Fahrzeug automatisch auf seinem Sollkurs zu fuhren. Daruber hinaus ist es moglich, Hindernisse im interessan- 

40 ten Verkehrsraum zu erkennen und aus der Positions^nderung die Geschwindigkeit und den iCurswinkel sowie 
die Beschleunigung und den KrQmmungswinkel der Hindernisbahn zu bestimmen. 

Die bekannten Verfahren zur automatischen Fahrzeugfuhrung eriauben es bisher aber nicht. uber die Hinder- 
niserkennung hinaus in kritischen Verkehrssituationen zur Vermeidurig von Kollisionen in Echtzeit kollisions- 
freie Sollbahnen fiir die Fahrzeugfuhrung vorzugeben und damit einem Hindernis auszuweichen und es zu 

45 passieren. In die bekannten Verfahren gehen bei Notfallmanovern auch nicht die physikalisch oder fahrzeugsei- 
tig bedingten Begrenzungen fur Beschieunigungen und Bremsmandver oder der begrenzte Raum fur Ausweich- 
manover quer zur Kursrichtung ein. 

• 5. Aufgaben 

50 . . 

Durch die Entwicklung der Sensortechnik ist es mogllch, die Positionen, Geschwindigkeiten und Kurswinkel 
von Hindernissen und Verkehrsteilnehmern im interessanten Verkehrsraum mit hoher Genauigkeit und Zuver- 
lassigkeit zu bestimmen. Der Erfindung liegt die Aufgabe zugrunde. durch Auswertung der Sensorinformaiionen 
Kollisionsgefahren zu erkennen und gegebenenfalJs mittels einer in Echtzeit arbeitenden Einrichtung zur KoJIi- 

55 sionsvermeidung unter BerOcksichtigung vorgegebener Beschrankungen Ausweichbahnen zu bestimmen und 
der Regelung fur die automatische Fahrzeugfuhrung entsprechende Soliwerte vorzugeben. 

6. Losung 

60 Die Aufgabe wird beziiglich des Verfahrens entsprechend deh im Anspruch I und beziiglich der Vorrichtung 
entsprechend den im Anspruch 14 bzw. 22 angegebenen Merkmalen gelost. Vorieilhafie Ausgesialtungen der 
Erfindung sind in den Unteranspruchen angegeben. 

Der erzielte Vorteil der Erfindung besteht darin. daQ die automatische Kollisionvermeidung in der Lage ist. 
schnell. d. h. ohne Schrecksekunde, kritische Verkehrssituationen zu erkennen und bei Kollisionsgefahr ohne 

65 Verzogerung in Echtzeit situationsgerechte Ausweichmandver einleitet. Damit ist es moglich, in Situationen, in 
denen der Fiihrer eines Fahrzeuges nicht mehr rechtzeitig und richtig reagieren kann» durch automatische 
Fahrmanover Unfalle zu vermeiden und die Sicherheii im StraOenverkehr zu erhohen. Daruber hinaus werden 
bei der Einleiiung von Kollisionsvermeidungsmanovern vorgegebene BeschrSnkungen. wie z.'B. die begrenzte 
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Fahrbahnbreite und die maximale Beschleunigung und Verzogerung des Fahrzeugs berucksichtigt 

Es wird nochmals angemerkt, daB die gesamte Schaltungs^nordnung in Digital- oder Analogtechnik ausgie- 
fuhrt sein kann. Ebenso moglich ist eine fest verdrahtete Vorrichtung, wobei aber genauso das gesamte Verfah- 
ren und die Vorrichtung unter Verwendung eines Mikroprozessors mit nur entsprechend elnem Softwarepro- 
gramin aktuell hergestellten Rechen-, Steuer- bzw.iSchaltzust^nden eine entsprechende funktionelle Steuerung 
durchgefQhrt warden kann. 

Die Erfindung wird in den Abschnitten 6.1 bis 6.6 beschrieben und an AusfQhrungsbeispielen dargestellt 
Zur weiteren Eriauterung sind die folgenden Figuren beigefugt: • 

Fig. 1 : Schematischer Aufbaii eines automatisch ftihrbaren Fahrzeugs mit Kollisionsvermeidungsvorrichtung 
Fig. 2:Gesamtstrukturder Fahrzeugftihrung 

Rg. 3: Einrichtung B zur Bestimmungder Fahrzeugsollbeschleunigung 

Fig. 4: Block 1 zur Ermittlung der Kollisionsparameter bei geradenformiger Bahnabschatzung 

Fig. 5: Block 1.1 (Bestandteil des Blocks I) 

Fig. 6: Block 1.2 (Bestandteil des Blocks 1) 

Fig4 7: Block 1.3 (Bestandteil des Blocks 1) 

Fig. 8: Block 1.4 (Bestandteil des Blocks 1) 

Fig. 9: Block 13 (Bestandteil des Blocks 1) 

Fig. 10: Block 1.6 (Bestandteil des Blocks 1) 

Fig. 1 1 : Block 1.7 (Bestandteil des Blocks 1) 

Fig. 1 2: Bahnabschatzung fur die Kollisiohsparameterbestimmung 
Fig. 13: Einrichtung KP zur KoUisionsparameterbestimmung 
Fig. 14: Einrichtung ATEzur Kollisionserkennung 
. Fig. 15: Einrichtung Szurdynaihischen Festlegung des Mindestabstandes 
Fig. 16: Sonderfall der Kollisionsvermeidung durch Bremsniandver 

Fig: 17: Einrichtung KVt zur Kollisionsvermeidung durch Brems- oder Beschleunigungsmanover 
Fig. 18: Block 1.8 (Bestandteil des Blocks /i: VI) 

Fig. 19: Bestimmung der Positionsquerverschiebung fiir seitliche Aus^veichmanover 
Fig. 20: Einrichtung KV2 zur Kollisionsvermeidung durch seitliche Ausweichmanover 
Fig. 21 : Block 2.1 (Bestandteil der Einrichtung KV2) 
Fig. 22: Block 2.2 (Bestandteil der Einrichtung KV2) 
Fig. 23: Block 2.3 (Bestandteil der Einrichtung i;:V2) 
: Fig. 24: Einrichtung R zur Ruckfuhrung der Sollbahn nach einem seitlichen Ausweichmanover 
Fig. 25: Einrichtung /CV3 zur Kollisionsvermeidung durch Folgen 
Fig. 26: Anwendungsbeispiel 1 

Fig. 27: Einrichtung KV-A USxur SoIlgroBenfestlegung 

Fig. 28: Einrichtung Ky4 fur eine vereinfachie Kollisionsvermeidung 

Fig. 29: Einrichtung R 4 zur Ruckfuhrung der Sollbahn nach einem Ausweichmanover mittels der Einrichtung 
Fig. 30: Anwendungsbeispiel 2 

Fig. 31 : Einrichtung (75 zur SoIlgroBenfestlegung . 

6.1 Kollisionsvermeidung fur automatisch fiihrbare Fahrzeuge 

Die Aufgabe wird erfindungsgem^B durch ein Verfahren zur automatischen Kollisionsvermeidung in Echtzeit 
fur automatisch fiihrbare Fahrzeuge gel5st. Dies erfolgt dadurch, daB aktuelle Daten Qber die Sollposition, den 
Sollkurswinkel, die Sollgeschwindigkeit, die Sollbeschleunigung urid den Krummungsradius der Sollbahn des 
Fahrzeugs sowie uber die Position, den Kurswinkel, die Geschwindigkeit, die Beschleunigung und deri Krum- 
mungsradius der Bahn eines Hindernisses durch am Fahrzeug angebrachte Sensoren ermittelt werden und/oder 
ganzoder teilweise durch eine externe Einrichtung mittels Dateniibertragung zum Fahrzeug iibermittelt werden 
und/oder ganz oder teilweise aus der zeitlichen Anderung der Fahrzeugsollposition und der Hindernisposition 
bestimmt werden. Ferner ist vorgesehen, daB die Kollisionsvermeidungsvorrichtung anhand der vbrgegebenen 
Daten die Bahn des Hindernisses und die Sollbahn des Fahrzeugs vorausschauend absch&tzt, den Zeitpunkt der 
engsten Ann^herung zwischen dem Fahrzeug und dem Hindernis sowie mindestens den Abstand der engsten 
Annaherung, gegebenenfalls zusatzlich den Winkel der engsten Annaherung, auf den abgesch^tzten Bahnen 
bestimmt, anhand der noch verbleibendeh Zeit bis zur engsten Annaherung und des Abstandes der engsten 
Annaherung eine eventuelle Kollisionsgefahr feststellt und gegebenenfalls die Sollposition und den Sollkurswin- 
kel oder die Sollgeschwindigkeit und die Sollbeschleunigung dahingehend verandert, daB das Fahrzeug das 
Hindernis unter Einhaltung eines Mindestabstandes passiert oder ihm folgt. SchlieBlich wirken die ursprungli- 
chen oder die im Fall einer Kollisionsgefahr y.eranderten SoDbahndaten durch eine .Einrichtung zur Fahrzeugre- 
gelung auf Stellglieder fiir die Lenkung und/oder den Antrieb und die Bremsanlage des Fahrzeugs. 

6.1.1 Aufbau und Gesamtstruktur der Fahrzeugfiihrung 

Der erfindungsgemaflen Losung der Aufgabenstellung liegt ein hierarchisch strukturiertes Konzept der 
Fahrzeugfiihrung zugrunde. 

Ein am Fahrzeug angebrachies Muliisensorsysiem beobachtet den Verkehrsraum vor dem Fahrzeug (Fig. 1 ). 
Aus den Sensordaten und vom Fahrer vorgegebenen Daten, z. B. uber eine Sollgeschwindigkeit oder einen 
Sollkurswinkel. werden SollgroBen fur die Position (xf\yF)><i'\^ Geschwindigkeit vfund den Kurswinkel v^des 



DE 38 30 790 Al 

Fahrzeuges sowie der KrOmmungsradius des Fahrbahnverlaufes rp bestimmt Mittets Datenubertragung kon- 
nen diese Daten auch an andere Verkehrsteilnehmer weitergegeben werden. 

Die Sollwertvorgabe bildet die obere Ebene der hierarchischen Struktur der Fahrzeugfiihrung (Fig. 2). Die 
Ebene der Sollwertvorgabe Qbergibt die SoUgrd&en xpt yp* VR VFund rp an die darunterliegende Ebene der 

5 KoUisionsvermeidung. Aufgrund der Ebene der KoUisjonsvermeidung ist es, vorausschauend anhand noch naher 
zu erllLuternder Verfahren die vorgegebenen Sollwerte daraufhin zu uberprOfen, ob Kbllisionsgefahr mit Hin- 
dernissen oder anderen Verkehrsteilnehmern besieht und notigenfalls neue Sollwerte fur ein Fahrmandver zur 
Vermeidung einer Kollision zu bestimnien. Hierbei werden andere Verkehrsteilnehmer im Sinne der Kollisions* 
vermeidungsstrategie auch als Hindernisse betrachtet 

10 Das bordeigene MuUisensorsystem erkennt Hindernisse und andere Verkehrsteilnehmer in der Umgebung 
des Fahrzeugs. Die Position (xH,yH) eines Hindernisses, dessen Geschwindigkeit vh> Kurswinkel khi Beschleuni- 
gung an und BahnkrCinunungsradius 77/ werden ermittelt oder aus der zeitlichen Fositionsanderung bestimmt 
und der Kollisionsvermetdungsvorrichtung Qbergeben. Die Krummungsradien der Hindernisbahn und der Fahr-. 
zeugsollbahn werden in Linkskurven positiv und in Rechtskurven negativ gerechnet 

15 Durch Datenubertragung zwischen verschiedenen Verkehrsteilnehmern und mdglichen zentralen Einrichtun- 
gen konnen ferner sensorisch nicht oder nur ungenau erfaBbare Daten ausgetauscht Wenn die KoUisionsver- 
meidungsvorrichtung anhand der Daten tiber das eigene Fahrzeug und iiber andere Verkehrsteilnehmer bzw. 
Hindernisse keine Kollisionsgefahr feststellt, werden die Sollwerte der SoUbahnvorgabe direkt auf die Ebene der 
. Fahrzeugregelung durchgeschaltet Im Falle einer Kollisionsgefahr werden die neu berechneten koUisionsfreien 

20 Sollwerte weitergegeben. 

Auf der Ebene der Fahrzeugregelung werden mit Hilfe geeigneter Regelungsverfahren die StellgroQen 
(Beschleunigungs- bzw. Bremskr&fte, Lenkwinkel) bestimmt, die auf die Fahrzeugdynamik wirken. Insoweit wird 
auch aiif die vom gleichen Anmelder am gleichen Tag eingereichte Patentanmeldung mit dem Titel 'Verfahren 
und Vorrichtung zur automatischen Fuhrung der Langs- und Querbewegungen von Fahrzeugen** verwiesen, 

25 deren Offenbarungsgehalt in voltem Umfange und phne jede Beschrankung ausdrucklich zum Inhalt dieser 
Anmeldung gemacht wird. 

6.1.2 Verfahren und Einrichtung /CPzur Kollisionsparameterbestimmung 

30. Das erfindungsgemafie Verfahren zur Kollisionsvermeidung beinhaltet eine Abschatzung des zu erwartenden 
kQnftigen Verlaufes der Sollbahn des Fahrzeuges und der Bahn des Hindernisses anhand aktueller Daten uber 
die Sollbahn des Fahrzeuges und die Bahn des Hindernisses. Aus der Abschatzung der Bahnverl^ufe ermittelt 
eine Vorrichtung zur Kollisionsparameterbestimmung die drei KolUsionsparanieter Kollisionsabstand fk, Kolli- 
. sionswinkel <pK und Kollisionszeit fj^. Die Koltisionszeit tK gibt die noch verbleibende Zeitspanne f^: bis zur 

35 erwarieten engsten Annaherung des Fahrzeuges und des Hindernisses an. Zum Zeitpupkt der engsten Annahe- 
rung befinden sich das Fahrzeug und das Hindernis im Kollisionsabstand rK und im Kollisionswinkel .^jc 
zueinander. Der KoHisionswinkel <pK bezieht sich auf ein ortsfestes Koordinationssystem. 

Mit Hilfe der KoHisionsparameter tK und fk wird eine Kollisionsgefahr erkannt (Abschnitt 6.1,3). Daruber 
hinaus gehen die KoHisionsparameter auch in die Sollwertbestimmung fur Kollisionsvermeidungsman5verein. 

40 Die KoHisionsparameter werden wahrend der Fahrt standig auf Basis der aktuellen Sensordaten uber die 
Sollbahn des Fahrzeugs und die Bahn des Hindernisses hach dem im fblgenden beschriebenen Verfahren neu 
bestimmt. 

Zur Erlauterung des Verfahrens wird zunachst angenommen, daB die Kurswinkel bis zur engsten Annaherung 
konstant sind. Die zukunftlgen Verlaufe der Fahrzeugsollbahn urid der Hindernisbahn werden geradenformig 
45 abgeschatzt. Die Kollisionsvermeidungsvorrichtung erhalt aus der Ebene der SoUbahnvorgabe die Sollwerte fur 
die Position (xf. yp), die Geschwindigkeit vfund den Kurswinkel v/^des Fahrzeuges sowie durch die sensorische 
Hinderniserkennung die Position (xh^ Yh), die Geschwindigkeit vh, die Beschleunigung an und den Kurswinkel 
yrdes Hindernisses (Fig. 2). Die Krummungsradien rfund r/f bleiben bei den geradenformigen Bahnabschatzun- 
gen unberucksichtigt. AHe Eingangssignale der.KoHisionsvermeidungseinrichtung werden in zeitlichen Abst^n- 
50 den At diirch .Sample & Ho1d>Glieder abgetastet und fur die weitere Signalverarbeitung uber einen Zeitschnitt 
konstant gehalten. 

Fur die Bestimmung der KoHisionsparameter wird zus^tzlich die Sollbeschleunigung arbendtigt, die mit Hilfe 
der in Fig. 3 dargestellten Vorrichtung B ermittelt wird oder auch als zusatzliche EingangsgroBe aus der Ebene 
der SoUbahnvorgabe yorgegeben wird. EingangsgroQen der Vorrichtung Bsind die Sollgeschwindigkeit v^aus 
55 der Ebene der Sollwertvorgabe und die Sollgeschwindigkeit vkv, die als AusgangsgroBe der Kollisionsvermei- 
dung an die Ebene der Regelung weitergegeben wird. i^ycv^wird vom Ausgang der Koltisionsvermeidungseinrich- 
tung auf den Eingang der Vorrichtung Szuruckgekoppelt. 

Die im Summierer 1 gebildete Differenz vp— VKVV^xrd im Multiplizierer 3 mil dem Fakior ai^multipliziert und 
im Sattigungsglied 5 auf den Bereich [amin* Bmax\ beschr&nkt. 
60 amax und amin sind frei vorgebbare Hochstwerie fur die Fahrzeugsollbeschleunigung bzw. -verzogerung. 

Mit den GroQen xf^ yp vp, vkv, ap xh. yhf, vh* 3h zum Zeitpunkt fo kann vorausschauend fur t> to der 
weitere Bahnverlauf J^fft), ypft) des Fahrzeugs und xnftX ynft) .des Hindernisses in kartesischen Koordinaien 
abgeschatzt werden. Im folgenden wird zuersi das Verfahren erlautert, das der Bestimmung der KoHisionspara- 
meter tfc, rK und <pk zugrunde liegt und dann die Vorrichtung besphrieben. AnschlieBend werden das Verfahren 
65 und die Vorrichtung fiir nicht geradenformigc Bahnabschatzungen erweitert. 

Wenn man. ohne die Allgemeinheit der Betrachtungen einzuschranken. to gleich Null seizi, gelten die Abschat- 
zungen 
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Xp(t)= XF^ (VKVt + \/2aFt^) COS VF 

yF(t) « y/r + (vKVt + \/2aFt^) sin V/r 
= w + ^I'z/r + l/2a//f2) COS V// 

■' . ■ " • 

Ftir die zeitliche Abstandsanderung />» ''^ kartesischen Koordinaten zwischen Fahrzeug und Hindernis 
ergibtsich 

• ' ■ • . 

rx(t) ^ XF(t) - jiH(t) 

ry(t)^yF(t)-yH(t)^ 

Mit den Abkurzungen 

* 

y^YF—yH 

Vy— Kjcvcosv/?— K//sin w 
ax ^Fcois v/r— a// COS v// 

kann man fur rjr(r^und r>/(^auch schreiben: 

O/C' y + + l/2ay/^. 

Der Abstand /ff^zwischen Fahrzeug und Hindernis berechnet sich zu 

* 

Als Kollisionszeit Ik wird von der ICollisionsvermeidungseinrichtung die noch verbletbende Zeit bis zum 
nachsten zukunftigen Minimum der Funktion r(t) bestimmt. Der Zeitpunkt Ik ergibt sich aus der zeitlichen 
Ableitung der Funktton /fr^durch die Forderung: , 



d/ . 



bzw. 



Es mtissen die Slullstellen der kubischen Gleichung 

bestimmt warden. 

Fur.die Koeffizienten cj. C\ und gilt: 



£> = 3 



ax^x ayVy 

+ a/ 



^ Vx^ + xa^ -f i^K^ + yay 



+ ay 



ax^ + ay 

Dies geschieht in einfacher Weise mit Hilfe der in der Literatur bekannten Cardanischen Losungsformel (s. 
z. B. Bronstein/Semendjajew: Taschenbuch der Mathematik 19. Auflage, S. 183). Man erhalt eine reeile Losung 
f>:ooderdrei reelle L6sungen tKu tKiund f/^^jder kubischen Cleichung. Damitdie Funktion r(t)e\n Minimum in 
einer der drei Losungen hai» muB weiterhin die Forderung 
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bzw. 

erfiillt sein. Bei der Existenz von drei reellen Losungen der kubischen Gleichung erhalt die Kollisionsvermei- 
dungselnrichtung durch Oberprtifung dieser Forderung zwet Minima des Abstands r(t), von deneh das zeitlich 
n^chstliegende zukOnftige Minimum die relevante Kollisionszeit tK bis zur engsten Ann^herung zwischen 
Fahrzeug und Hindemis angibt. 
10 Zum Zeitpunkt rjcbefinden sich das Fahrzeug und das Hindernis in x- und in y-Koordinaten in den Abstsihden 

rKx^ X + VxtK + Vl^Lxt^d 

15 zueinander. 

Die Kollisionsvermeidungseinrichtung ermittelt den Kollisionsabstand rjcund den KolHsionswinkel ^i^als 
.9K^ arctan . 

Im Falle einer unbeschleunigten relativen Bewegung zwischen dem Hindernis und dem Fahrzeug/ajr«ay=0) 
vereinfacht sich die kubische Gleichung zu einer linearen Gleichung und die Kollisionsvermeidungseinrichtuhg 
bestimmt die Kollisionszeit rj^» Ika als 

25 

t - + yvy 

Die mit Block 1 bezeichnete Einrichtung in Fig. 4 bestimmt nach dera oben beschriebenen Verfahren die 
30 Kollisionsparameter ^a:, rATund v>A:rnit Hiife geradenformiger Bahnabschatzungen. 

Block 1 ist unterteilt in die Unterbldcke i.l bis 1.7 (Obertragungsglieder 2, 4» 6, 8» 10, t2» 14. 16 und 18), die in 
den Fig. 5 bis 1 1 noch einmal einzeln dargestellt sind. 

Block 1.1 (Fig. 5) bestimmt aus den Eingangssjgnalen xf. yr, ^F, vkv, XH^yn, vih vh und a// die Koeffizienten 
c\ und Q) der kubischen Gleichung. AuBerdem ermittelt Block 1.1 die Kollisionszeit Ika* die sich im Fall 
35 ^jT^ + ay^ssO durch Losiing der vereinfachten linearen Gleichung ergibt. tKA und das Beschleunigufigsquadrat 
« Bj^-^-a/ sind neben cj, C\ und co AusgangsgrdBen von Block 1.1. 

Nach der Bestimmung der Sintjswerte (Sinusglied 11 iind 15) und der Cosinuswerte (Cosinusglied 13 und 17) 
der Kurswinkel vf und vh und der Zerlegung der Geschwindigkeiten vkv (Muliiplizierer 21 und 19). vh 
(Multiplizierer 29 und 27) und der Beschleunigungen apCMultiplizierer 25 und 23), a/y(Multiplizierer 33 und 31) in 

40 ihre Anteile in x- und y-Richtung ergeben sich die Relativposiiion at, y (Summierer 35 und 37), die Relativge- 
schwindigkeiten Vx, j^^(Summierer 41 und 39) und die Relativbeschleunigungen ax, ay(Summierer 45 und 43). Als 
nachstes werden die GroBen Vy^ (Multiplizierer 47), Vx^ (Multiplizierer 49), By^ (Multiplizierer 51), Bx'^ (Multipli- 
zierer 51), Bx^ (Multiplizierer 53), xvx (Multiplizierer 55). yvj^ (Multiplizierer 57). xBx (Multiplizierer 59), yay 
(Multiplizierer 61), a^Kv (Multiplizierer 63) und a>Vy (Multiplizierer 65) bestimmt. Der Summierer 69 addiert ax^ 

45 . und a/ zur AusgangsgrdBe 2?, Die GrdBen Vj? und vy^ werden im Summierer 67. addiert. Um Divisionen durch 
Nullen in den Dividierern 89, 91;93 oder 95 zu vermeiden, werden die AusgangsgroBen der Summierer 67 und 69 
in den Maximumgliedern 85 und 87 beim Unterschreiten der Werte £v2 oder €a2 durch ev2 bzw. €^2 ersetzt. 

Der Dividierer 89 bestimmt C2, indem er die Summe der Signale BxYx und ay vy (Summierer 75), die zuvor im 
Proportionalglied 79 mit dem Faktor 3 multipliziert wird, durch das Ausgangssignal des Maximumgliedes 87 

50 dividieri. Der Dividierer 91 bestimmt die AusgangsgroBe c\ des Blocks 1.1, indem er die Summe der GroBe Kx^, 
Vy^, XBx und yay (Summierer 67, 73 und 77), die im Proportionalglied 81 mit dem Faktor 2 multipliziert wird, durch 
das Ausgangssignal des Maximumgliedes 87 dividiert. 

Die GroBen xvx und yvy werden im Summierer 71 addiert, im Proportionalglied 83 mit dem Faktor 2 
multipliziert und im Dividierer 93 durch das Ausgangssignal des Maximumgliedes 87 dividiert Damit licgt die 

55 GroBe als Ausgangssignal des Dividierers 93 v6r. Der Dividierer 95 bestimmt die AusgangsgroBe 4, indem 
er das Ausgangssignal des Summierers 71, das im Proportionalglied 84 invertiert wird, durch das Ausgangssignal 
des Maximumgliedes 85 dividiert. 

Der Block 1.2 dient dazu. die Koeffizienten c^, ci und co, die AusgangsgroBen des Blocks 1.1 sind, auf die 
Koeffizienten der reduzierten kubischen Gleichung (s. Bronstein/Semendjajew: Taschenbuch der Mathemaiik, 

60. 19. Auflage, S. 183) zu iransformieren. Hierzu wird die GroBe im Multiplizierer 97 mit C\ multipliziert und das 
Ergebnis im Proportionalglied 99 mit dem Faktor 1/3 gewichtet. Im Multiplizierer 103 wird caquadriert und das 
Quadrat im Multiplizierer 105 noch einmal mit C2 multipliziert. Die Ausgangssignale der Multiplizierer 103 und 
. 105 werden durch die Proportionalglieder 107 bzw. 109 mil den Faktoren l/i bzw. 2/27 multipliziert. Die 
AusgangsgroBe p ergibt sich durch Subtraktion (Summierer 111) des Ausgangssignals des Proportionalgliedes 

65 107 vort der EingangsgroBe C\. Der Summierer 101 bildet die AusgangsgroBe q durch Addition der Eingangsgro- 
Be Co mit dem Ausgangssignal des Proportionalgliedes 109 und Subtraktion des Ausgangssignals des Proportio- 
nalgliedes 99. 

• Nachdem im Block 1.1 die Koeffizienten C2, c\ und Ojdes kubischen Polynoms bestimmt wurden und Block 1.2 
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jdtese auf die Koeffizlenien p und q eines reduzierten Polynoms transformiert hat, ermittelt Block \3 (Fig. 7) nun 
die Nullstellen des reduzierten Polynoms uhd transformiert sie zurUck auf das ursprungliche Poiynom. 

Hierzu werden als erstes aus den Eingangssignalen p und q, die die GrdBen D und p bestimmt. p ist das 
Ausgangssignal des Wurzelgliedes 139, Das Eingangssignal des Wurzelgliedes 139 wird durch MuUiplikation von 
p mit dem Faktor 1/3 (Proportionalglied 115), ansqhlieBendes Quadrieren (Multiplizierer 119) und nochmalige 5 
MultipHkation mit p/3 (Multiplizierer 123) bestimmt Die GroBe Dist das Ausgangssignal des Summierers 125, 
der zum Ausgangssignal des Multiplizierers 123 das Quadrat (Multiplizierer 121) der mit 1/2 gewichteten 
EingangsgroBe q addiert (Proportionalglied 117). Die Gr6Be D ist Ausgangssignal des Blocks 13. Wenn D 
grdBer ist als Null, hat die kubische Gleichung nur eine reelle Ldsung tKo (Summierer 137). Andernfalls gibt es 
drei reelle Losungen tK u tK2 und tK3 (Summierer 167, 169 und 171). lo 

Zur Bestimmung von tKo wird die Quadratwurzel aus Dberechnet (Wurzelglied 127). Vom positiven Wert 
(Summierer 129) und vom negaiiven Wert der Quadratwurzel (Summierer 130) wird das Ausgangssignal q/2 des 
Proportionaigliedes 1 17 subtrahiert. Aus den Ausgangssignalen der Summierer 130 und 129 wird in den WurzeU 
giiedern 131 und 133 die dritte Wurzel gezogen und anschlieBend werden beide Signale im Summierer 135 
addiert Das Ausgangssignal des Summierers 135 ist die reelle Losung des reduzierten Polynoms im Falle D. is 
groBer NjjI). Durch Subtraktion von c^/3 (Proportionalglied 113) im Summierer 137 ergibt sich die entsprechen-- 
de Ldsung tjc^o des ursprunglichen Polynoms. 

Zur Bestimmung der Losungen fjci, tK2 und fjc3 im Fall D kleiner Null wird die AusgahgsgroBe q/2 des 
Proportionaigliedes 117 mit negativem Vorzeichen im Dividierer 143 durch die GroBe p (AusgangsgrdBe des 
Wurzelgliedes 139) dividiert Vom Ergebnis der Division wird im Arcuscosinusglied 147 der Arcuscosihus 20 
berechnet und dieser anschlieBend im Proportionalglied 149 mit dem Faktor 1/3 multipliziert Das Ausgangssi- 
gnal des Proportionaigliedes 149 geht auf die Summierer 153 und 155, wo die Werte 2 n/3 bzw. 4 7t/3 aufaddiert- 
werdeni Auf die Cosinusglieder 151, 157 und 159 werden die Ausgangssignale des Proportionaigliedes 149 bzw. 
der Sunimierer 153 und 155 geschaltet Die Losungen der reduzierten Gleichung ergeben sich als Ausgangssi- 
gnale der Multiplizierer 161, 1(63 und 165, die die Cosinussignale der Cosinusglieder 151, 157 und . 159 mil dem 25 
Ausgangssignal des Proportionaigliedes 145 multiplizieren. Das Proportionalglied 145 multipliziert die im Wur- 
zelglied 141 gebildete dritte Wurzel der Gr5Be p (Ausgangssignal des Wurzelgliedes 139) mit dem Faktdr 2. 
Durch Subtraktion des Ausgangssignales des Proportionaigliedes 113 von den Ausgangssignalen der Multipli- 
zierer 161, 163 und 165 in den Summierer 167, 169 und 171 werden die AusgangsgrdBen rxh tK2 und tKZ des 
Blocks 1.3 gebildet 30 

Die Ausgangssignale a^, ci und t/cA des Blocks 1.1 sowie die Ausgangssignale £>, tKOy tK \, tKi und tK^ des 
Blocks 13 sind Eingangssighale des Blocks 1.4 (Fig. 8), der die KoUisionszeit tK bestimmt Die im folgenden 
haufig verwendeten Schaltglieder (z. B. Schaltglied 213) schalten bei positivem Signal am Steuereingang das mit 
"-f " gekennzeichnete Eingangssignal durch. Andernfalls wird das mit gekennzeichnete Eingangssignal 
weitergeschaltet Wenn das am Steuereingang des Schaltgliedes 213 aniiegende Ausgangssignal des Summierers 35 
211, der den Parameter vom Eingangssignal subtrahiert negativ ist, d. h. wenn das Eingangssignal des 
Blocks 1.4 kleiner ist als der frei einstellbare Parameter wird das Eingangssignal tKA des Blocks 1.4 direkt als 
Ausgangssignal f/^durchgeschaltet Als Parameter Sa^ wird der untere Grenzwert eingestellt, ab dem als gleich 
Null gilt Wenn groBer ist als wird das Ausgangssignal des Schaltgliedes 209 weitergeschaltet Als 
-Steuersignal des Schaltgliedes 209 dient das Eingangssignal D, so daB bei positivem D das Eingangssignal tK 0 des 40 
Blocks 1.4 auf den positiven Eingang des Schaltgliedes 213 durchgeschaltet wird. Bei negativem £>schaltet das 
Schaltglied 209 das Ausgangssignal des Schaltgliedes 207 durch. Das Ausgangssignal des Schaltgliedes 207 gibt 
bei der Existenz von drei reellen Nullstellen des kubischen Polynoms (negatives D^die relevante KoUisionszeit 
/Aran. 

Um diese zu ermitteln wird das Eingangssignal tK\ im Proportionalglied 173Thit dem Faktor 2 gewichtet und 45 
dann im Multiplizierer 175 mit der EingangsgrdBe ci multipliziert Im Summierer 189 wird das Ausgangssignal . 
des Multiplizierers 175 zur EingangsgroBe C\ und zur AusgangsgrdBe des Proportionaigliedes 179 addiert, 
welche sich ergibt aus dem Quadrat der EingangsgroBe f/ci (Multiplizierer 177) multipliziert mit dem Faktor 3 
(Proportionalglied 179). Analog wird das Eingangssignal tK 2 im Proportionalglied 181 mil dem Faktor 2 gewich- 
tet und dann im Multiplizierer 183 mit der EingangsgroBe multipliziert Im Summierer 191 wird das Ausgangs- 50 
signal des Multiplizierers 183 zur EingangsgroBe C\ und zur AusgangsgrdBe des Proportionaigliedes 187 addiert 
welche sich ergibt aus dem Quadrat der EingangsgroBe tK2 (Multiplizierer 185) multiphziert mit dem Faktor 3 
(Proportionalglied 187). 

Die Ausgangssignale der Summierer 191 und 189 sind die Steuersignale der Schaltglieder 193 und 195. Bei 
positivem Ausgangssignal des Summierers 191 schaltet das Schaltglied 193 die EingangsgrdBe tK2 durch. 55 
Ansonsten wird die EingangsgroBe tKz durchgeschaltet Bei positivem Ausgangssignal des Summierers 189 
schaltet das Schaltglied 195 die EingangsgroBe tK \ durch. Ansonsten wird die EingangsgrdBe ^/c 3 durchgeschal- 
tet Die beiden Ausgangssignale der Schaltglieder 193 und 195 geben die Zeitpunkte der Abstandsminima an. 

Das Ausgangssignal des Schaltgliedes 193 geht auf den Steuereingang und den positiven Eingang des Schalt- 
gliedes 199 sowie auf den negativen Eingang des Schaltgliedes 197. Umgekehrt geht das Ausgangssignal des 60 
Schaltgliedes 195 auf den Steuereingang und den positiven Eingang des Schaltgliedes 197 und auf den negativen 
Eingang des Schaltgliedes 199. In dem Sonderfall, daB eines der Ausgangssignale der Schaltglieder 193 und 195 
positiv ist und eines negativ ist wird sowohl vom Schaltglied 197, als auch vom Schaltglied 199 das positive Signal 
weitergegeben. Die Ausgangssignale der Schaltglieder 197 und 199 gehen auf die Betragsglieder 201 bzw. 203. 
Im Summierer 205 wird vom Ausgangssignal des Betragsgliedes 203 das Ausjgangssignal des Betragsgtiedes 201 65 
subtrahiert. Das Ausgangssignal des Summierers 205 ist Sieuersignal des Schaltgliedes 207. Am positiven 
Eingang des Schaltgliedes 207 liegt das Ausgangssignal des Schaltgliedes 197. Am negativen Eingang des 
Schaltgliedes 207 liegt das Ausgangssignal des Schaltgliedes 199. 
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Der in Block 1 (Fig. 4) zweifach (Fahrzeug und Hindernis, Obertragungsglied 10 und 12) verwendete Block 1.5 
(Fig. 9) bestimmt die zurOckgelegte Strecke As (AusgangsgroBe des Summierers 223) und den Kurswinkel P 
(AusgangsgroBe des Summierers 227) des Fahrzeugs bzw. des Hindernisses nach Ablauf der Kollisionszeit fjc. 
EingangsgroBen des Blocks sind die Kollisionszeit tK» die Geschwindigkeit v, die Beschleunigung a, der Kurswin* 

5 kel V und der KrOmmUngsradius r. Der Summierer'223 addiert das Produkt der EingangsgrdBen tK und v 
(Multiplizierer 215) zu dem Produkt des Quadrates der EingangsgrdBe fi^(Multipllzierer 21)0 mit der Eingangs- 
grdGe a. (Multiplizierer 219) und dem Faktor 1/2 (Proportionalglied 221). AusgangsgrdBe des Summierers 223 ist 
die Strecke As, Der Dividierer 225 dividiert ids' durch den Krummtingsradius r. Das Ausgangssignal des Dividie- 
rers wird im Summierer 227 mil der EingangsgrdBe v addiert Das Ergebnis der Summation ist die Ausgangsgro- 

10 Be Pdes Blocks 1.5. Bei geradenformiger Sollbahnabschatzung (unendlicher Kriimmungsradius) ist das Aus- 
gangssignal des Dividierers 225 gleich Null, so daB die EingangsgroBe v des Blocks direkt als AusgangsgroBe 9 
durchgeschaltet ist 

Ebenso wie Block 1.5 ist auch der folgende Block 1.6 (Fig. 10) doppelt (d. h. einmal fur das Fahrzeug und 
einmal fiir das Hindernis* Obertragungsglied 14 und 16) im Block 1 (Fig. 4) vorhanden. Block 1.6 bestiitimt die 

is Position des Fahrzeugs bzw. des Hiiidernisses in x^-Koordinate (Ausgangssignal des Summierers 257) und 
>^Koordinate (Ausgangssignal des Summierers 259) nach Ablauf der Zeit tKr Eingangssignale des Blocks 1.6 sind 
die augenblickliche Position (x, y), der KrQmmungsradius r, der von Block 13 bestimmte Kurswinkel nach 
Ablauf der Zeit tic der augenblickliche Kurswinkel vund die von Block \3 bestimmte Strecke As. Das Sinusglied 
229 und das Cosinusglied 231 ermittein den Sinus bzw. den Cosinus des Winkels f>. Das Sinusglied 233 und das . 

20 Cosinusglied 235 ermittein den Sinus bzw^ Cosinus des Winkels v. Der Summierer 237 subtrahiert den Sinus des 
Winkels worn Sinus des Winkels 9, Der Summierer 239 subtrahiert den Cosinus des Winkels P vom Cosinus des 
Winkels v. Die Differenzen der Sinus- bzw. Cosinuswerte werden in den Multiplizierern 241 iind 243 rnit dem 
KrQmmungsradius r multipliziert AuBerdem werden der Sinus* und der Cosinuswert des Wmkels v in den 
Multiplizierern 245 und 247 mit dem Signal As multipliziert Im BetragsgUed 249 wird der Betrag des Krum- 

25 mungsradius gebildet Der Summierer 251 siibtrahiert den frei vorgebbaren Parameter rmax vom Betrag des 
KrOmmungsradius. Das Ausgangssignal des Summierers 251 ist Steuersignat der Schaltglieder 253 und 255. 
Wenn der Betrag des KrOmmungsradius groBer als der Parameter rmajr ist, werden jfund j^auf geradenfOrmigen 
Bahnabschatzungen bestimmt Bei positivem Steuersignal, d. h. wenn der Betrag des Krummungsradius groBer 
ist als der Parameter rm^Xf schaltet das Schaltglied 253 das Ausgangssignal des Multiplizierers 247 und das 

30 Schaltglied 255 das Ausgangssignal des Multiplizierers 245 durch. Andernfalls schaltet das Schaltglied 253 das 
Ausgangssignal des Multiplizierers 241 und das Schaltglied 255 das Ausgangssignal des Multiplizierers 243 
durch. Der Summierer 257 addiert die AusgangsgroBe des Schaltgliedes 253 zur EingangsgroBe x und ermittelt 
so die AusgangsgrdBe x des Blocks 1.6. Die AusgangsgroBe / wird vom Summierer 259 durch Addition der 
EingangsjgroBeyzur AusgangsgrdBe des Schaltgliedes 255 gebildet . 

35 Die Ausgangssighale der beiden Bl5cke 1.6 sind Eingangssignale als Block 1.7 (Fig. II) gekennzeichneten 
Obertragunggliedes 18 in Rg. 4, der die Kolltsionsparameter fk und <pK bestimmt Im Summierer 261 wird die 
x-Positipn ^//des Hindernisses von der x-Position x/rdes Fahrzeugs subtrahiert. Genauso wird im Summierer 
263 die Position pHd^s Hindernisses von der y-Position y/rdes Fahrzeugs subtrahiert Das Arcustangensglied 
bildet den Winkel ^j^aiis dem Ausgangssignal des Summierers 263 als Gegenkathete und des Summierers 261 

40 als Ankatheie. Der Multiplizierer 265 quadriert das Ausgangssignal des Summierers 261 und der Multiplizierer 
267 quadriert das Ausgangssignal des Summierers 263. Die beiden Quadrate werden im Summierer 269 addiert 
Aus der Summe bestimmt das Wurzelglied 273 die Quadratwurzel. Das Ausgangssignal rjc des Wurzelgliedes 
273 ist zusammen mit q>K Ausgangssignal des Blocks 1.7 Gleichzeitig sind rjc und >jc zusammen mit der 
Kollisionszeit fjc (Ausgangssignal des Schaltgliedes 213 in Block 1.4) die Ausgangssignale des ubergeordneten 

45 Blocks 1: 

Die Berechnung der KoUisionsparameter rjc. fK und (pK mil der als Block 1 bezeichneien Vorrichtung basiert 
auf einer geradenformigen Abschatzung der Fahrzeugsoilbahn und der Hlndernisbahn fiir t> tQ. Bei einer 
Anderung der Kurswinkel ist diese Abschatzung nicht mehr exakt Bei groBeren Kurswinkelandcrungen miissen 
deshalb die Krummungsradien beriicksichtigt werden. 

50 Durch eine nicht geradenformige Abschsitzung der Bahnen laQi sich das Abstandsminimum zum Zeitpunkt der 
engsten Annaherung zwischen Fahrzeug und Hindernis nicht mehr analytisch bestimmen. da nichtlineare Terme 
auftreten. Deshalb muB die Kollisionszeit tK, die angibt, wieviel Zeit vom augenblicklichen Zeitpunkt to bis zum 
Kollisionszeitpunkt (b+ f/cvergeht, n^herungsweise berechnet werden. 

Mit der Annahme, daB der KrQmmungsradius der Bahnen sich nur unwesentlich gndern, kann eine kreisformi- 

55 ge Abschatzung der Bahnen erfolgen. Wenn sensprisch Anderungen des Kriimmungsradius mil hinreichender 
Genauigkeit effaBbar sind. konnen auch diese in die Abschatzung der Bahnen einbezogen werden. In diesem Fall 
werden die Bahnen nicht kreisformig mit konstaniem KrOmmungsradius, sondern mit sich sietig vergroOerndem 
Oder verkleinerndem Kriimmungsradius abgeschalzt Das im folgenden eriauterte Verfahren zur Kollisionspara- 
meterbestimmung fiir kreisformige Bahnabschatzungen ist grundsatzlich auch auf andere nicht geradenformige 

bO Abschatzungen anwendbar. 

ErfindungsgemaB wird bei nicht geradenformigen BahnverUufen des Fahrzeuges oder des Hindernisses eine 
kreisformige Abschatzung der kunftigen Bahh verlaufe vorgenommen. 

In ^quidistanten ZeitabsiSnden ^Ir werden die Sensorsignale abgetastet und die Kollisionsvermeidungsvor 
richtUng fiihrt eine neue Bestimmung der aktuellen Kollisionsparameter durch. Aus dem vorherigen Zeiischriit 

65 zum Zeitpunkt to— At ist die Kollisionszeii Ik.bU bekannt Als voraussichtlicher Kollisionszeitpunkl ergibt sich 
nach dem letzien Zeitschritt der Zeitpunkt to^At-^ tK,a/t- Im neuen Zeitschriii werden nun die Positionen des 
Fahrzeuges und des Hindernisses auf den kreisformig abgeschatzlen Bahnen zum Kollisionszeitpunkl 
Ui — At-^- fK.a/i bestimmt Im ersien Schriu wird iK,ah^At geseizt sp daB die zu bestimmcnden Positionen gleich 
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den augenblicklichen Positionen sind. 

An die Positionen des Fahrzeuges und des Hindernisses zum Zeitpunkt ta—At-^ tjca/t ^uf den abgeschatzten 
Bahnen werden Tangenten gelegt Zur Berechniing der aktuellen KolHsionszeit werden nun ein fiktives Fahr- 
zeug und ein fiktives Hindernis eingefOhrt, die sich auf den Tangentenbahneh bewegen (Fig. 12). Die KolHsions- 
vermeidungseinrichtung linearisiert also die Kreishahneri um den Punkt der erwarteten engsten Annaherung. . s 
Dabei passieren das reale und das fiktive Fahrzeu'g. bzw. Hindernis zum Zeitpunkt zlr+ tx^ft den jeweiligen 
Berfihriingspunkt der Tangenten und der Kreisbahnen. Zu diesem Zeitpunkt stimmen die Kurswinkel die 
Geschwindigkeiten und die Positionen des fiktiven und des realen Fahrzeuges bzw.- Hindernisses uberein. Die 
Berechnung der aktuellen Kollisionszeit durch die Kollisionsvermeidungsvorrichtung erfolgt, indem das vorher 
beschriebene Verfahren fQr geradenformige Bahnabschatzungen nun auf das fiktive Fahrzeug und Hindernis auf lo 
den Tangentenbahnen angewandt wird. 

Zusammenfassend kann die erfindungsgem^Be Bestimmiing der Kollisionsparameter (k, tK und ^jc durch die 
KolHsionsvermeidungsvorrichtung folgenderma&en beschrieben werden. 

Bei geradenformiger Bahnabschatzung wird die Kollisionszeit fjc direkt durch Berechnung des nSchsten 
Minimums der Abstandsabsch&tzung zwischen Fahrzeug und Hindernis bestimmt. Bei nicht geradenfdrmiger is 
Bahnabschatzung werden die Bahnverl§ufe durch Tangenten an die erwarteten Punkte der engsten Anniherung 
aus dem vorherigen Schritt linearisiert und die Kollisionszeit durch Bestimmung des Abstandsminimums fur 
die Tangentenbahnen berechnet Mit Hilfe der Kollisionszeit rjc wird aus den Bahnabschatzungen der Kollisions- 
abstand r^^und der Kollisjonswinkel 9>x^ zwischen Fahrzeug und Hindernis ermittelt 

Zur Bestimmung der Kollisionsparameter fx, tk und ((>k nach dem beschriebenen Verfahreri mittels kreisfdr- 20 
miger Bahnabschatzung wird die als Block I (Fig. 4) bezeichnete Einrichtung J5CP(Fig, 13) erweitert. Block I ist 
als Obertragungsglied 291 Bestandteil der Einrichtung KP. Die ursprOnglichen Eingiangssignale jtk^k vf. vk xy, 
YHf v/fund v//des Blocks 1 werden ersetzt durch xp^yPf vf; 9RXH,yH,^H^T^d vh, 

jpFund 7f sind die Ausgangssignale des als Obertragungsglied 277 gekennzeichneten Blocks 1.6 v/rfst Aus- 
gangssignal des Blocks 1.5 (Obertragungsglied 275). Dieser Block bestimmt aus der AusgangsgroBe des Summie- 25 
rers 297, die die zu erwartende Kollisionszeit fj<^a/f— zlf nach der Berechnung im letzten Zeitschritt angibt, und 
den EingangsgroBen vp vr* und rp den Kurswinkel vf der Tangehtenbahn des fiktiven Fahrzeugs und die 
verbleibende Strecke bis zum Zeitpunkt tQ—At+ tfc^aU- Der Block 1.6 (Obertragungsglied 277) ermittelt die 
Position j(Ff ypdes Fahrzeugs zum Zeitpunkt fe— tfc^u aus den Eingangssignalen xp yp vf und rpund den 
Ausgangsgr5Ben des Blocks 1.5 (Obertragungsglied 275). Der Multiplizierer 279 rnultipliziert das Eingangssignal . 30 
af-mit dem Aus^angssignal des Summierers 297. Der Summierer 281 bestimmt das Signal 9p das Eingangssignal 
des Blocks I (Obertragungsglied 291) ist, durch Addition des Eingangssignals vp zum Ausg^ngssignal des 
Multiplizierers 279. _ 

in und jp// sind die Ausgangssignale des als Obertragungsglied 285 gekennzeichneten Blocks 1.6 vh ist 
Ausgangssignal des Blocks 1.5 (Obertragungsglied 283). Dieser Block bestimmt aus der AusgangsgroBe des 35 
Summierers 297, die die zu erwartende Kollisionszeit fj^^//— ^f_nach der Berechnung im letzten Zeitschritt 
angibt und den EingangsgroBen y/y, vh* a// und r//den Kurswinkel v// der Tangenten bahn des fiktiven Hindernis- 
ses uiid die verbleibende Strecke bis zura Zeitpunkt to-^At-{' tK.atu Der Block 1.6 (Obertragungsglied 285) 
ermittelt die Position xh* y// des Hindernisses zum Zeitpunkt (b— + f/^^/f aus den EingangsgrdBen xh* yHi VH 
und rn und den AusgangsgroBen des Blocks 1 JS (Obertragungsglied 283). Der Multiplizierer 287 rnultipliziert das 40 
Eingangssignal a;/ mit dem Ausgangssignal des Summierers 297. Der Summierer 289 bestimmt das Signal vh^ das 
. Eingangssignal des Blocks 1 (Obertragungsglied 291) ist. durch Addition des Eingangssignals v^zum Ausgangs- 
signal des Multiplizierers 287. 

Die AusgangsgroBen y/c und ^j^des Blocks 1 (Obertragungsglied 291) sind direkt auch AusgangsgrdBen der 
Einrichtung KP. Die dritte AusgangsgroBe des Blocks 1, die in Fig. 4 als Kollisionszeit tK bezeichnet ist. gibt in 45 
der Einrichtung /^P nicht mehr direkt die Kollisionszeit. sondern die Anderungz4f/rder Kollisionszeit gegeniiber 
dem Ausgangssignal tK.ait-^At des Summierers 297 an. Der Summierer 293 addiert die Anderung Atx zum 
Ausgangssignal des Summierers 297 und bestimmt so das Ausgangssignal tK der Einrichtung /^P. Das Totzeit- 
glied 295 verzogert das Ausgangssignal tK um einen Zeitschritt At Der Summierer 297 bildet das Signal 
tK,Bit^Au indem er vom Ausgangssignal desTotzeitgliedes 295 die Zeitschrittwerte /Irsubtrahiert. 50 

6.1.3 Verfahren und Einrichtung /CEzur Kollisionserkennung 

Anhand der Ausgangssignale tK und r^c der Einrichtung KP^xg, 1 3), die in Abschnitt 6.1.2 beschrieben wurde, 
bestimmt die Kollisionserkennungseinrichtung das Signal kg, Bei positivem kg ist Kollisionsgefahr gegeben. 55 
Ansonsten hat /c^ einen negaiiven Wert. Wenn Kollisionsgefahr erkannt wird, muB die Kollisionsvermeidungs- 
vorrichtung neue Sollwerte bestimmen und an die Ebene der Fahrzeugregelung weitergeben, 

ErfindungsgemaB wird das Signal Ar^durch die Kollisionserkennungseinrichtung wie folgt bestimmt. 

. . / 1 fiir (r, < hy - a {t^ < hy ■ a (^^ > 0) 

^ " I - 1 snnsl 

Hierbei gibt rm/nrf einen Mindestabstand an, der beim Passieren des Hindernisses eingehalten werden muB. 
fmind kann der Kollisionserkennungseinrichtung (Fig. 14) als frei wahlbarer fester Parameter, aber auch als 
zeitlich veranderliche GroBe in Abhangigkeit, z. B. von der Geschwindigkeit vf* dem Kurswinkel v/r und dem 
Kollisionsparameter (pFSOwie von Fahrzeugparameiern p\ bis pm durch eine Einrichtung 5(Fig. 15) vorgegeben 
werden. Die Zeii tkrit gibt die sogenannte kritische Zeitspanne an. ab der die automatische Kollisionsvermeidung 
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friihestens etngreift Als W wird die Zeitspanne vorgegeben. die ein Fahrer bendtigt, um selbstlindig und gezielt 
ein KLolHsionsvermeidungsmandver durchzufuhren. Der Faktor hy w'trd abhlngig vom Wert kggn des Signals kg 
im vorherigen Zeitabschniu giesetzt 



1 rUr kg^t, = I 



Durch Wahl eines Wertes /f^graQer 1 fOr A:^a//« 1 wird ein st&ndiges Wechseln der GroBe Ag^bei Werten rjc 

10 und f/r in der Nahe von rm/Ac/ und fiknV verhindert 

Die Einrichtung KEzuv KoUisionserkennung ist in Fig. 14 dargestellt. Im MultipUzierer SOl wird das Ein- 
gangssignal rmindmt dem Faktor hy, der Ausgangssignal des Schaltgliedes 315 ist» muhipliziert Ebenso wird der 
Parameter tkrit im MultipUzierer 303 mit dem Faktor Aymultipliziert Im Summierer 305 wird das Eingangssignal 
r/: vom Ausgangssignal des Multiplizierers 301 subtrahiert. Im Summierer 307 wird das Eingangssignal fjc vom 

15 Ausgangssignal des Multiplizierers 303 subtrahiert Das Ausgangssignal des Summierers 307 ist Steuersignal des 
Schaltgliedes 309, das bei positivem Steuersignal den Wert +1 und sonst den Wert —1 durchschaltet Das 
Ausgangssignal des Summierers 305 ist Steuersignal des Schaltgliedes 311, das bei positivem Steuereingang das 
Ausgangssignal des Schaltgliedes 309 und sonst den Wert — 1 durchschaltet. Das Ausgangssignal des Schaltglie- 
des 311 stellt das Ausgangssignal A^der Einrichtung /CEdar. Im ToUeitglied 313 wird das Signal kg um einen 

20 Zeitschritt At verzogert Das Ausgangssignal des Totzeitgliedes 313 steuert das Schaltglied 315^ Bei posiCivem 
Steuersignal wird der Wert iJS, ansonsten der Wert 1 .0 als Faktor /ry durchgeschaltet 

Der Mindestabstand r/„;w kann durch die in Fig. 15 dargestellte Einrichtung 5 bestimmt werden. Im Summie- 
. rer 317 wird das Eingangssignal vf vom Eingangssignal q>k subtrahiert. Das Kennlinienglied 319 bildet das 
Ausgangssignal des Summierers 317 entsprechend der im Kennlinienglied skizzierten Kennlinie auf den Werte- 

25 bereich 0 bis +1 ab. Das Eingangssignal VFwird im Proportionalglied 321 mit dem frei vorgebbaren Faktor m 
muliipliziert. Die Ausgangssignale des Proportionalgliedes 321 und des Kennliniengliedes 319 wefden.im MuUi- 
pjizierer 323 miteinander multipJiziert. Der Summierer 327 addiert zum Ausgangssignal des Multiplizierers 323 
den Wert der im Obertragungsglied 325 abhangig von Parametern pup2,... bis pm festgelegt wird. Ober die 
Parameter Pi, p2 bis pm gehen die Fahrzeugabmessungen lind die Genauigkeit der Sensoren in die Bestimmung 

30 von rm/i7</ein. Das Ausgangssignal des Summierers 327 stellt das Ausgangssignal r^m^ der Einrichtung 5dar. 

6.2 Verfahren und Einrichtung KVi zur Kpllisionsvermeidung durch Brems- oder Beschieunigungsmanover 

Ziel der Strategic der Kollisionsvermeidung durch Brems- oder Beschieunigungsmanover ist es,.eine Be- 
35 schleunigung (bzw. Verzogerung) axvi zu finden. die sicherstellt, daB das Fahrzeug das Hindernis in einem 
Mindestabstand rn,/;,,/ passiert 

In Abschnitt 6.1.2 ist ein Verfahren und eine Einrichtung KP zur Kotlisionsparameterbestimmung erlautert 
worden, die in Abh^ngigkett von den GroBen r//, XH,yH.yH, m a//fur das Hindernis und r/?, xf, yp, vkv, wf, a^fur 
das Fahrzeug den Kollisionsabstand rK besiimmen. Wenn man sILmtliche EingangsgroBen mit Ausnahme der 
40 Fahrzeugbeschleunigung als Konstanten und die Fahrzeugbeschleunigung als Variable a auffaBt, so kann man 
den Kollisionsabstand als eine Funktion r(a)dtr Variablen a interpretieren, deren Funktionswerte mit dem oben 
erlauterten Verfahren bestimmt werden. Insbesondere gilt 



Ziel der Kollisionsvermeidunjg durch Brems- oder Beschieunigungsmanover ist es, eine Beschleunigung 
a^aKV\zu finden, fur die sich ein Kollisionsabstand 

rfaKVl) = rmind 

ergibt,d. h. das Fahrzeug so zu bremsen oderzu beschleunigen.daB das Hindernis in einem Mindestabstand rmi„d 
. passiert wird. 

ErfindungsgemaB wird aKv i naherungsweisc von der Kollisiohsvermeidungsvorrichiung wie folgt bestimmt: 



Hierbei ist aKv\,a/( der Wen des Signals aKV\ im letzten Zeilschriu. Im ersien Schriti wird aKV\,ait zu ay 
60 gewahli. ^ia ist ein vorgebbarer Parameter. 

Die Kollisionsvermeidungseinrichtung KV \ muQ in jedem Zeitschritt fiir die Bestimmung von bkvi zweimal 
entsprechend dem in 6.1.2 beschriebenen Verfahren einen Kollisionsabstand berechnen. Aus den so erhaltcnen 
Werten fur die Kollisionsabsiande r(aKV\,a/t-^ Aa) und rfaKVi.ait) ergibt sich nach der obigen Rechenvorschrift 
die neue Sollbeschleunigung a/cvi. 

fts Fur die Anderung der Beschleunigung aKv\ pro Zeilschriu wird eine betragsmaBige Obergrenze AaKVi,max 
' eingefuhrt. 



.max 



I axvi — aKV\.ait \ < AaKV\j 

■ 10 
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Die vom Fahrzeug realisierbare Beschleunigung bzw. Verzdgerung ist aufgrund der maximalen Motorleistung 
und der begrenzten Verz6gerung bei einem Bremsmanover (Haftretbung Reifen-StraBe) auf ein Intervall [av» 
beschrinkt 

Wenn das Signal Wert bkvx auBerhalb des Intervalls [a^^ at] Hegt, kann das Fahrzeug das Hindemis durch ein 
Brems- Oder Beschleunigungsmanover nicht passiercn. 5 

Bei einem Fahrmanover mit a/cvi aus dem Intervall [a^ at] ist gesichert, daB der geforderte Mindestabstand 
/OT//7^2um Hindernis nicht unterschritten wird. 

Wie in Fig. 16 anschaulich dargestellt ist, konnen aber Falle auftreten, bei denen das Fahrzeug das Hindernis 
nicht passiert In Fig. 16 ist eine Situation gegeben, in der sich das Fahrzeug mit hoher Geschwindigkeit von 
hinten einem Hinderniis nahert, welches sich mit geringer Geschwindigkeit und dem gleichen KursWinkel auf der lo 
Fahrbahn des Fahrzeuges bewegt Das Fahrzeug wurde ohne einen Eingriff der KolUsionsvermeidungseinrich- 
tung nach Ablauf der Kollisionszeit tK auf das Hindemis auffahren. Durch ein leichtes Bremsmandver konnte 
eine KolHsion nicht verhindert werden, da sich nur die Kollisionszeit vergr5Bert. Erst wenn die Verzdgerung 
ajcvi so groB wird, daB das Fahrzeug hinter dem Hindernis auf die Hindernisgeschwindigkeit abgebremst wird, 
findet keine Kotlision statt. In diesem Falle wird das Hindernis aber auch nicht passiert Nach dem Zeitpunkt der 15 
engsten Annaherung im Abstand r/nwd bestunde keine Kollisionsgefahr mehr und das Fahrzeug wiirde erneut 
beschleunigt. Nach kurzer Zeit wiirde die Kollisionsvermeidungseinrichtung aber wieder eine Kollisionsgefahr 
erkennen, so daB es zu einem standigen Hin- und Herschalten der GroBe kgktkme, 

Um diese'n Sonderfall zu erkennen» berechnet die Kollisionsvermeidungseinrichtung die Fahrzeuggeschwin- 
digkeit Pf und die Hindernisgeschwindigkeit Ph sowie die Kurswinkel v p und v m des Fahrzeuges und des 20 
Hindernisses zum Zeitpunkt der engsten Ann^herung bei einer Beschleunigung aKvi des Fahrzeuges. 



. yKVtK + 1/2 aKV\ tK^ 

V F ^ VF + : 

^ VHtK + 1/2 antjd 

Zum Zeitpunkt der engsten Annaherung bewegen sich Fahrzeug und Hindernis mit der Geschwindigkeit VreJ 
zueinander. 

\ _ _ ■ 

VrcJ = ]/(PFCOSy F ^ v/v COS V hY + (vpsm V H — ^HSxn V hY 



25 



30 



35 



Wenn Vrei gleich ■ Null ist bzw. kleiner als ein Grenzwert Sv, der durch die begrenzte Genauigkeit der 
Signalverarbeitung bedingt wird, liegt der oben dargestellte Sonderfall vor. 

Das Hindernis kann nur durch ein seitliches Abweichen von der Sollbahn passiert werden. Wenn zu einem 
solchen Cberholmanover nicht genQgend Platz zur VerfOgung steht, muB das Fahrzeug dem Hindernis unter 
Einhaltung eines Mindestabstandes rmm^/folgen. 40 

Die in Fig. 17 dargestellte Vorrichtung KV\ bestimmt nach dem beschriebenen Verfahren entsprechend 
Anspruch 1 eine Beschleunigung aKVx. die die Elnhaliung des Mindestabstands rmmj zwischen Fahrzeug und 
Hindernis sichert. 

In die Vorrichtung KV \ sind zwei Blocke vom Typ Block KP zut Bestirfimung von Kollisionsparametern 
(Obertragungsgiied 329 und 331) integriert, deren Aufbau in Fig. 13 dargestellt ist und in Abschnitt 6.1.2 bereits 45 
erlautert wurde. Das Obertragungsgiied 331 unterscheidet sich dadurch von der in Abschnitt 6,1.2 beschriebenen 
Vorrichtung, daB der Ausgang <pK nicht ausgefuhri ist, d. h. das Obertragungsgiied 271 (Block 1.7, Fig. 11) 
entfallt. Im Obertragungsgiied 329 wird daruberhinaus der Ausgang des Summierers 293 (Fig. 13) nicht nach 
auBen gefuhrt. 

Eingangssignale der beiden Obertragungsglieder 329 und 33 1 vom Typ der Einrichlung KPsind die Signale xf, 50 
yp, VK vKVf rp xhp yHf m m an und rn sowie beim Obertragungsgiied 329'das Ausgangssignal aKvx.ait-^ ^a des 
Summierers 337 bzw. beim Obertragungsgiied 331 das Ausgangssignal aKV],eJt des Schaltgliedes 335. Ausgangs- 
signal des Obertragungsgliedes 329 ist die GroBe r(aKV],ait-^ ^a). Entsprechend ist die GroBe r(aKV},a/t) Aus- 
gangssignal des Obertragungsgliedes 331, welches als zweites Ausgangssignal die GrdBe tK(aKV\.ait) auf den 
Eingang des Blocks 1.8 (Obertragungsgiied 355) gibt. Das Ausgangssignal des Totzeitgliedes 353 liegt am 55 
positiven Eingang des Schaltgliedes 335. Am negativen Eingang des Schaltgliedes 335 liegt das Eingangssignal ap 
der Einrichtung KV\. Als Steuersignal des Schaltg;liedes 335 dient das Ausgangssignal kgait des Totzeitgliedes 
333, welches das Signal kg um eineri Zeitschritt A( verzdgert. Das Signal ajcvi.ayf +4a wird im Summierer 337 
durch Addition des Parameters Aa zum Ausgangssignal des Schaltgliedes 335 gebildet. 

Als Steuersignal des Schaltgliedes 339 dient das Ausgangssignal kgau des Totzeitgliedes 333. Bei positivem hO 
kg^h schaltet das Schaltglied 339 das Ausgangssignal r(aKV\.ait) des Obertragungsgliedes 331 weiier. Ansonsten 
wird das Eingangssignal fk der Einrichtung KV \ durchgeschaltet. 6er Summierer 341 subtrahiert das Aus- 
gangssignal des iSchaltgliedes 339 vom Eingangssignal rmind Der Summierer 343 subtrahiert das Ausgangssignal 
des Schaltgliedes 339 vom Ausgangssignal r(aKV\Mh-^ Aa)dts Obertragungsgliedes 329. Das Ausgangssignal des 
Summierers 341 wird im Dividierer 345 durch das Ausgangssignal des Summierers.343 dividiert. Der Multiplizie- hs 
rer 347 multipliziert das Ergcbnis der Division mit dem Parameter Aa. Das Ausgangssignal des Multiplizierers 
347 wird im Sattigungsglied 349 auf den Bereich zwischen AaKV\.max und — AaKV\.maj( beschrSnkt und im 
Summierer 351 ziir AusgangsgroBe des Totzeitgliedes 353 addiert. Das Ausgangssignal des Summierers 351 isi 
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Eingangssignal des Totzeitgliedes 353 und gleichzeitig Ausgangssignal axvi der Vorrichtung KVt, AuBerdem 
ist es neben dem Ausgangssignal tK(BKV\^t) des Obertragungsgliedes 331 und den Signalen tf, vkv, vf, m vh, stH 
und VH Eingangssignal des als Block 1.8 (Fig. 18) bezeichneten Ubertragungsgliedes 355. 

In Block 1.8 sind zwei Obertragungsglieder (357 und 359) vom Typ Block \JS (Fig. 9) enthaJten. Der Ausgang 
5 -45(Summierer 223 wird bei beideri Blocken nicht nach auOen gefQhrt Das Obertragungsglied 357 bestimmt aus 
den Eingangssignalen r/c VKV, bkvx und v/rdas Signal v /r. Das Obertragungsglied 359 bestimmt aus den 
Eingangssignalen m tK, m a// und v//das Signal v //. Das Sinusglied 369 ermittelt den Sinus von v pmd das 
Cosinusghed 371 ermittelt den Cosinus von v f. Entsprechend bestimmen das Sinusglied 373 und das Cosinus- 
glied 375 den Sinus bzw. den Cosinus von v Der Multiplizierer 361 multipliziert die Eingangssignale t und a 

to Auf das Ergebnis der Multiplikation wird im Summierer 365 das Eingangssignal v^vaddiert Auf das Ausgangssi- 
gnal des MulUphzierers 363, der die Eingangssignale tK und an multipliziert, addiert der Summierer 367 das 
Eingangssignal vh. Das Ausgangssignal des Summierers 365 wird im Multiplizierer 377 mit dem Ausgangssignal 
des Sinusgliedes 369 und im Multiplizierer 379 mit dem Ausgangssignal des Cosinusgliedes 371 multipliziert Das 
Ausgangssignal des Summierers 367 wird im Multiplizierer 381 mit dem Ausgangssignal des Sinusgliedes 373 

15 und im Multiplizierer 383 mit dem Ausgangssignal des Cosinusgliedes 375 multipliziert Das Ausgangssignal des 
Summierers 385, der das Ausgangssignal des Multiplizierers 381 vom Ausgangssignal des Multiplizierers 377 
subtrahiert, wird im Multiplizierer 389 quadriert Das Ausgangssignal des Summierers 387, der das Ausgangssi- 
gnal des Multiplizierers 383 vom Ausgangssignal des Multiplizierers 379 subtrahiert, wird im Multiplizierer 391 
quadriert Der Summierer 393 addiert die Ausgangssignale der Multiplizierer 389 und 391. Aus dem Ergebnis der 

20 Summation zieht das Wurzelglied 395 die Quadratwurzel v^k welche im Summierer 405 vom Parameter £y 
subtrahiert wird Das Ausgangssignal des Sumniierers 405 ist Steuersignal des Schaltgliedes 407, welches bei 
positivem Steuersignal den Wert 4-1 und sonst den Wert —1 durchschahet Das Ausgangssignal 6© des Schalt- 
gliedes 407 ist Ausgangssignal des Blocks 1;8 und der Einrichtung AT VI. 

Das Ausgangssignal des Summierers 397. der das Eingangssignal aKV\ vom Parameter at subtrahiert. ist 

25 Steuersignal des Schaltgliedes 401. Bei positivem Steuersignal, d. h. wenn aKV\ kleiner als a^ ist wird der Wert 
, +1 durchgeschaltet Andernfalls wird der Wert —1 durchgeschahet Der Summierer 399 subtrahiert den 
Parameter ay von dem Eingangssignal a/cvi- Das Ausgangssignal des Summierers 399 liegt am Steuereingang 
des Schaltgliedes 403. Bei positivem Steuersignal, d. h. wenn aKV\ groBer ais avist; schallei das Schaltglied 403 
das Ausgangssignal des Schaltgliedes 401 durch. Andernfalls wird der Wert - 1 weitergegeben. Das Ausgangssi- 

30 gnal des Schaltgliedes 403 ist Ausgangssignal 5i des Blocks 1,8 und auch Ausgangssignal der Einrichtung KV\, 

6.3 Verfahren und Einrichtung KV2 zur KoIIisionsvermeidung durch seitliche Ausweichmanover 

Zur Eriauterung des Grundgedankens des Verfahrens zur KoIIisionsvermeidung durch seitliche Ausweichma- 
35 nover nehme man an, es existiere ein fiktives Fahrzeug, daB sich mit der gleichen Geschwindigkeit Beschleuni- 
gung und Kurswinkel bewege, wie das tatsachliche Fahrzeug. Das fiktive Fahrzeug sei in seiner Position aber 
gegenuber dem tatsachlichen Fahrzeug seitlich, d. h. qiier zum Kurswinkel, urn den Abstand rq versetzt r« wird 
positiv gerechnet wenn das fiktive Fahrzeug in Fahrtrichtung links vom tatsachlichen Fahrzeug liegt Wenn das 
fiktive Fahrzeug rechts liegt wird rq negativ gerechnet Der Bahnkrummungsradius fFo des fikiiven Fahrzeuges 
40 ergibtsichzu 

rpq ^ rp — Tq. 

Dazu sei noch einmal darauf hingewiesen, daB vereinbarungsgemaB der Kriimmungsradius in Linkskurven 
45 positiv und in Rechtskurven negativ gerechnet wird (s. Abschnitt 6.1.1). Die Position (xfq, yPo) des fiktiven 
Fahrzeuges lautet v v 



50 



XPq ^ XF— rqSin VF 
yPq » + r^COS VF 



Mit dem in Abschnitt 6.1.2 eriauterten Verfahren kann der Kollisionsabstand rxq des fiktiven Fahrzeuges 
abhSngig von der normalen Posilionsverschiebung rq als Funktion rKq(rq) bestimmt werden. Dazu werden die 
GroBen XF.yFmd r^des tatsachlichen Fahrzeuges durch XFq,yFq und rFq ersetzt. Die Beschleunigung wird nicht 
varuert Ziel der KoIIisionsvermeidung durch seitliche Ausweichmanover ist es nun. die normale Positionsver- 
S5 schiebung rq so zu bestimmen, daB 

rKq(rq) = rmihd 
gilt 

bO In der noch verbleibenden Zeit tK bis zur engsten Annaherung wird die Sollposition des Fahrzeuges dann in 
eineni steiigen Ubergang in die um /v^quer verschobene Position des fiktiven Fahrzeuges uberfiihrt 

ErfindungsgemaB fuhri die Kollisionsvermeidungseinrichtung KV2, der das beschriebene Verfahren zugrun- 
dehegt die folgenden Schritte aus. Zunachst wird der Kollisionabstand rKq. der Kollisionswinkel (pKq und die 
Kollisionszeii tKq bei einer Positionsverschiebung r,,,/, bestimmt rq^att ist der im letzten Zeitschriii bestimmte 
65 Wert fur ImerstenZeitschriti wird r^.a/r gleichrmmdgeseizt 

Der Kollisionsabstand rKq wird im folgenden mit positivem Vorzeichen gerechnet wenn das Hindernis zum 
Zeitpunkt der engsten AnnSherung rechts vom Sollkurs liegt Ansonsten geht rKq mit negativem Vorzeichen ein 
rKq wird deshalb mit dem Faktor 
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.= sign ^(pxg - Vf- (jf^Kti + ^y) ^ '^^•""^J 



muUipliziert. Obeer.den letzten Term im Argument der Signum-Funktion wird die Kurswinkelanderung wah- 
rend der Kollisionszeit fx'^j. berucksichtigL Ebenso wie rKq geht auch der Kollisionsabstand ric des Fahrzeuges in 
seiner ursprunglichen Sollposition mit einem Faktor 



y = sign j^^A - ^Va k'a .+ ^''y) ^ '^^J 



em. 

Nachdem die Kollisionsvermeidungseinrichtung KV2 die Grofien y und yq bestimmt hat, werden die Ver- 
schiebungen rqji und r^^re fur ein Ausweichmandver nach links oder nach rechts ermittelt 

^ _ ro.BU(rmind- Y Tk) 
^ ^ roMt (—rmind ~ Y rid 

YqrKq-yrK • . 
Die Positionsverschiebung rq wird von der Kollisionsvernneidungseinnchtung V2 entsprechend der Regel 



\ r^ ,^ fur Ir^.r, - g(tK) r^.nh '< I V/» " ^Ok) Vw/ • A r^,r^ > r^, «„ 



mux 



festgelegt (s. Fig. 5). Die Werte fq^max und rq^min geben die maximal zuldssigen normalen Abweichungen von der 
Sollbahn an (Fahrbahnbreite). g(tKi ist eine Obergangsfunktion, die in Abhingigkeit von fx- Werte zwischen 0 
und 1 annimmt 

Die Obergangsfunktion g(tK) dient dazu, die Sollposition des Fahrzeuges in einem stetigen Obergang bis zum 
Zeitpunkt der engsten Annaherung in die um rq verschobene Lage zu Oberfuhren. g(tKi muB die folgenden 
Eigenschaften haben: 

g(tkrii)= 0 . . 



d 



= 0 



d 



d/ 



K 



= 0 



Die Obergangsfunktion 



erfullt die obigen Forderungen. 

Die Querverschiebung rq wird so festgelegt, daB die Begrehzungen rq^mnx und rq,min fur Ausweichmandver 
nach links und nach rechts nicht verletzi werden und die verbleibende Querverschiebung | rqj{^g(tK) rq^ah I bzw. 
I rq,rc—g(tK) fq \ moglichsf kleln ist, Wenn sowohl r<7,/i als auch rq,rc auQerhalb des zulassigen Bereiches [rq^miny 
rq,max\ Hegcn, kann das Hindernis nicht durch ein seitliches Ausweichmanover passiert werden. 

Die Kollisionsvermeidungseinrichiung KV2 ermittelt die Sollposition xkv2, yKV2 auf der Ausweichbahn wie 
foigt: 

■ 

XKV2 XF— g(tK).rqS\r\(vf^ 

yKV2 ^ yp-^ g(tK) rqcosfvpy 

Die Kollisionsvermeidungseinrichtung KV2 berechnet auBerdem einen neuen Kurswinkel fiir die Ausweich- 
bahn. Das Fahrzeug erhalt auf der Ausweichbahn einen zusatzlichen Geschwindigkeitsanieil Vq quer zum 
ursprunglichen Kurswinkel. Es gill 

= -j7 "^-'''^ d7;r ^''"^^ 
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' * * ' " * 

Der neue Kurswinkel ergibt sich zu 
VKV2 = VF + arctan — ^ — . 

10 . VKValt 

Die KolHsionsvermeidungseinrichtung KV2 greift nicht in die Sollgeschwindigkeit ein, d. h. der ursprungliche 
Wert aFder Sollbeschleunigung wird unverandert zur Aufintegraiion der Sollgeschwindigkeit weitergegeben. 

Die in Fig* 20 dargestellte Kollisionsvermeidungseinrichtung KV2 beinhaltet die Blocke 2.1 (Obertragungs- 
15 glied 501), 2.2 (Oberlragungsglied 503) und 23 (Ubertragungsglied 505). die in den Fig. 21 bis 23 gesondert 
dargestelit sind. 

Block 2.1 (Fig. 21) bestimmt aus den Eingangssignalen rmhtd» rq, pK, tK, W VR VKV, br xh, yn. bh, m vh 
und m die QuerverschiebuAgen rqjjmd rq^ fur Ausweichmanover nach links oder rechts quer zum Kurswinkel. 
Das Sinusglied 529 und das Cosinusglied 531 ermitteln den Sinus bzw. den Cosinus des Kurswtnkels vp. Das 

20 Eingangssignal rg wird im Totzeitglied 525 urn einen Zeitschritt At verzogert. Das Ausgangssignal rq^ait des 
Totzeitgliedes 525 wird im Multiplizierer 533 mil dem Sinus des Kurswinkels vf (Sinusglied 529) und im 
Multiplizierer 535 mit dem Cosinus des Kurswinkels VF(Cosinusglied 531) muUipliziert. Durch Subtraktion des 
Ausgangssignals des Multiplizierers 533 vom Eihgangssignals jtf bestimmt der Summierer 537 die Position xi^q. 
Die Position ypq wird vom Summierer 539 durch Addition der EingangsgroBe >7=-und des Ausgangssignals des 

25 Multiplizierers 539 gebildet. Der Summierer 527 bestimmt den Krummungsradius rpq durch Subtraktion des 
Ausgangssignals r<gi.a/r des Totzeitgliedes 525 von der EingangsgroBe rp. Die Signale xpq, ypq, vf, vkv, bf, rpq, xh, 
YH, v« VHf a// und r//sind die Eingangssignaie der Einrichtung KP, die als Obertragungsglied 541 Bestandteil des 
Blocks 2.1 ist und die GrdBen rxq, pKq und tKq ermittelt Block 2.1 beinhaltet weiterhin zwei Obertragungsglie- 
der (543 und 545) vom Typ Block 1.5, bei denen der Ausgang des Summierers 223 im Gegensatz zur Darstellung 

30 in Fig. 9 nicht nach auBen gefuhrt ist. Das Obertragungsglied 543 bestimmt aus den Eingangssignalen tKq* vkv. 
BF, vpund rpq den Kurswinkel des Fahrzeugs nach Ablauf der Zeit tKq yind bei einer Querverschiebung der 
Position um rq^^t. Entsprechend bestimmt das Obertragungsglied 545 aus den Eingangssignalen tK, rKV, aPt 
und r/rden Kurswinkel des Fahrzeugs nach Ablauf der Zeit tK auf der originalen Sollbahn. Das Ausgangssignal 
des Obertragungsgliedes 543 wird im Summierer 547 vom Ausgangssignal q>Kq der Einrichtung ^Psubtrahiert. 

35 Das Signumglied 549 bestimmt aus dem Ausgangssignal des Summierers 547 den Vorzeichenfaktor yq. Entspre- 
chend bestimmt das Signurhglied 559 aus dem Ausgangssignal des Summierers 557, der das Ausgangssignal des 
Obertragungsgliedes 545 von der Eingangsgr5Be q>K subtrahiert, den Vorzeichenfaktor y. Der Summierer 553 
subtrahiert die im Multiplizierer 561 mit dem Vorzeichenfaktor ymultiplizierte GroBe rjc von der im Multiplizie- 
rer 551 mit dem Vorzeichenfaktor yq multiplizierten GrdBe rKq^ AiiBerdem wird die mit y multipliziene GroGe 

40 rK im Summierer 563 vom Eingangssignal rm'md und im Summierer 565 vom negativen Eingangssignal —rmind 
subtrahiert Das Signal rq^n (Totzeitglied 525) wird im Multiplizierer 567 mit dem Ausgangssignal des Summie- 
rers 563 und im Multiplizierer 569 mit dem Ausgangssignal des Summierers 565 multipliziert. Der Dividierer 571 
bildet das Ausgangssignal rqji des Blocks 2.1, indem er das Ausgangssignal des Multiplizierers 567 durch das 
Ausgangssignal des Summierers 553 dividiert. Entsprechend dividiert der Dividierer 573 das Ausgangssignal des 

45 Multiplizierers 569 durch das Ausgangssignal des Summierers 553 und bestimmt so das Ausgangssignal r^re des 
Blocks 2.1. 

Block 2.2 (Obertragungsglied 503, Fig. 20) bestimmt abhangig von der EingangsgroBe tK und dem Parameter 
rjirmden Wert ^der Obertragungsfunktion und den Wert ^vzur Bestimmung der Quergeschwindigkeit Vq, Wie in 
Fig. 22 dargestellt, bestimmt der Dividierer 575 das Signal tK/tkriu das im Multiplizierer 577 quadriert wird und 

50 dessen Quadrat im Multiplizierer 579 noch einmal mil (K/tkrit multipliziert wird. Der Summierer 585 bestimmt 
das Ausgangssignal g des Blocks 2.2. indem er das im Proportionalglied 583 mil dem Fakior 2 gewichiete 
Ausgangssignal des Multiplizierers 579 mit dem im Proportionalglied 581 mit dem Faktor —3 gewichteten 
Ausgangssignal des Multiplizierers 577 und der Konstanten 1 addiert. Der Summierer 587 subtrahiert das 
Ausgangssignal des Dividierers 575 vom Ausgangssignal des Multiplizierers 577. Das Ergebnis der Subtraktion 

55 wird im Proportionalglied 589 mit dem Faktor —6 gewichtet und im Multiplizierer 591 mit der GroBe tkm 
multipliziert. Das Ausgangssignal des.Multiplizierers 591 ist die AusgangsgroBe ^i^des Blocks 2.2. 

EingangsgroBen des in Fig. 23 dargestellten Blocks 2.3. der als.Obertragungsglied 505 (Fig. 20) Bestandteil der 
Einrichtung KV2 ist, sind die Ausgangssignale rqji und Pq^rc des Blocks 2.1 und das Ausgangssignal ^des Blocks 
2.2 sowie das ruckgekoppelte Ausgangssignal rq des Blocks 2.3. Das Totzeitglied 593 verzogert die ruckgekop- 

60 pelie GroBe rq um einen Zeitschritt At zur GroBe rqaft. die im Multiplizierer 595 mit dem Eingangssignal g 
multipliziert wird und ausschliefllich im Summierer 597 von der EingangsgroBe rqj,- und im Summierer 599 von 
der EingangsgroBe rq^re subtrahiert wird. Das Absolutglied 601 bildet den Betrag des Ausgangssignals des 
Summierers 599 und gibi diesen auf den Summierer 605, der hiervpn den im Absolutglied 603 gebildeten Betrag 
des Ausgangssignals des Sunrimierers 597 subtrahiert und das Ergebnis der Subtraktion als Sieuersignal auf das 

65 Schaltglied 615 gibt. Der Summierer 607 subtrahiert das Eingangssignal r,y.// vom Parameter r<^m«jr. Der Summie- 
rer 609 subtrahiert den Parameter rq,'mi„ vom Eingangssignal r^rc Das Ausgangssignal des Summierers 609 ist 
Steuersignal der Schaliglieder 611 und 617. Wenn das Ausgangssignal des Summierers 609 positiv ist, d. h. wenn 
rq.re grower ist als r^.m/n, schaltet das Schaltglied 61 1 die EingangsgroBe rq,re und das Schaltglied 617 den Wert 1 
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durch. Andernfalls schaltet das Schaltglied 611 die EingangsgroBe rqji und das Schaltglied 617 den Wert —1 
durch. Das Ausgangssigna! des Summierers 607 ist Steuersignal der Schaltglieder 613 und 619. Wenn das 
Ausgangssignal des Summierers 607 positiv ist, d. h. rqji kleiner ist als rq^ax, schaltet das Schaltglied 613 das 
Eingangssignai rqji und das Schaltglied 619 den Wert 1 durch. Andernfalls schaltet das Schaltglied 613 das 
Eingangssignal rq^re und das Schaltglied 619 das Ausgangssignal des Schaltgliedes 617 durch. Die GrdBe rq ist 5 
Ausgangssignal des Schaltgliedes 615, das bei positivem Steuersignal das Ausgangssignal des Schaltgliedes 61 1 
und sonst das Ausgangssignal des Schaltgliedes 613 durchschaltet Das Ausgangssignal S2 des Schaltgliedes 619 
ist positiv, wenn r<7 innerhalb des Intervalls [r<7^m/n» /"(j^majr] Hegt . . 

Die Ausgangssignale Tq und ^2 des Blocks 23 (Obertragungsglied 505, Fig. 20) sind Ausgangssignale der 
Einrichtung KV2, Das Signal wird im Multiplizierer 525 mit der AusgangsgroBe g des Blocks 2.2 und 10 
anschlieBend im Multiplizierer 513 mit dem im Sinusglied 509 bestimmten Sinus des Winkels VFund im Multipli- 
zierer 515 mit dem im Cosinusglied 511 bestimmten Cosinus des Winkels i/r multipliziert Der Summierer 517 
ermittelt die AusgangsgroBe xkv2, indem er das Ausgangssignal des Multiplizierers 513 von der EingangsgroBe 
jTFSubtrahiert. Der Summierer 519 addiert das Ausgangssignal des Multiplizierers 515 zur EingangsgroBe y^uhd 
erhait so die AusgangsgrdBc yjcv2. Das Arcustangensglied 521 bildet den Arcustangiehs der GroBe Vq/vKV, i5 
wobei vq das im Multiplizierer 507 bestimmte Produkt der AusgangsgroBe rq des Blocks 2.3 und der Ausgangs- 
groBe gv des Blocks 2.2 ist. Das Ausgangssignal v/cv^2 ergibt sich im Summierer 523 durch Addition der 
AusgangsgroBe des Arcustangensgliedes 521 und der EingangsgroBe vp. 

Nachdem das Fahrzeug das Hindernis mit einer normalen Positionsverschiebung Vq im Sicherheitsabstand 
r/„;wpassiert hat, fuhrt eine Einrichtung R die Sollposition des Fahrzeuges in einem stetigen Obergang innerhalb 20 
der Zeit tmck auf die ursprungliche SoUbahn zuruck. Dazu wird zum Zeiipunkt der engsien Annaherung, d. h. 
wenii tK negativ wird und kgvon 1 auf — 1 umschaltet, die augenblickliche Querverschiebung rq gleich r^um der 
Sollposition gespeichert. Wahrend der Zeitspanne track nach dem Zeitpunkt der Umschaltung der GrdBe kg, der 
ohne Beschrankiing der Allgemeinheit der folgenden Betrachtungen gleich Null gewahlt wird, bestimmt die 
Ruckfuhrvorrichtung die Sollposition x/?.^/? und deh Sollkurswinkel v/? wie folgt: 25 

XR^ XF— g(t)rq,umS\r\(VF) 
YR ^ YF g(t) rq,umCOS (VF) 



VR = VF + arctan ^CiiiSLgv 



VKV 



mit 



g =— 1/— Y-— 1 



2 

+ I 



50 



35 



40 



Eingangssignale der Einrichtung R (Fig. 24) zur Riickfuhrung der Fahrzeugsollposition auf die ursprungliche 
Sollbahn sind die AusgangsgroBe r<,der Einrichtung KV2i die AusgangsgrdBc kg der Einrichtung KEund die 
Signale vf» vjcv, xFund yf Das Eingangssignal kgvtwd im Totzeitglied 621 uni die Zeitspanne truck verzogert Die 45 
GroBe kg ist Steuersignal des Schaltgliedes 623, das bei positivem kg den Wert 0 und sonst den Wert 1 
durchschaltet. Das Ausgangssignal des Totzeitgliedes 621 steuert das Schaltglied 625, das bei positivem Steuersi- 
gnal das Ausgangssignal des Schaltgliedes 623 und sonst den Wert 0 durchschaltet. Das mit 53 bezeichnete 
Ausgangssigna! des Schaltgliedes 625 nimmt nach dem Umschalten der GroBe kg von +1 auf — l .fur eine 
Zeitspanne track d^n Wert 1 an und hat sonst den Wert Null. Mit der positiven Flanke des Ausgangssignals des 5c 
Schaltgliedes 625 wird der Integrierer 629 auf den Wert 0 gesetzt und das Sample & Hold-Glied 627 tastet das 
Signal rq ab und halt den augenbllcklichen Wert rq^um bis zur nachsten positiven Flanke. Der Integrierer 629 
integriert das Ausgangssignal des Schaltgliedes 625 auf. Der Summierer 631 subtrahiert das Ausgangssignal. des 
Integrierers 629 vom Parameter truck. Das Obertragungsglied 633 vom Typ Block 2.2 bestimmt aus der Grofle 
trQck und dem Ausgangssignal des Summierers 631 die GroBen ^und gv. Das Ausgangssignal rq^um des Sample & st 
Hold-Gliedes 627 wird im Multiplizierer 635 mit g und anschlieBend im Multiplizierer 641 mit dem im Sinusglied 
637 gebildeten Sinus des Eingangssignals v/^bzw. im Multiplizierer 643 mit dem im Cosinusglied 639 gebildeten 
Cosinus des Eingangssignals v^multipliziert. Der Summierer 645 ermittelt die AusgangsgroBe xr, indem er das 
Ausgangssignal des Multiplizierers 641 von der EingangsgroBe jtf subtrahiert. Der Summierer 647 addiert das 
Ausgangssignal des Multiplizierers 643 zur EingangsgroBe yrund erhait so die AusgangsgroBe yr- Das Arcus- ec 
tangensglied 651 bildet den Arcustangens der GroBe v^^vkv, wobei Vq das im Multiplizierer 649 gebildete 
Produkt aus rq um und ist. Das Ausgangssignal v;? ergibi sich im Summierer 653 durch Addition der Ausgangs- 
groBe des Arcustangensgliedes 651 und der EingangsgroBe v f 

6.4 Verfahren und Einrichtung /Cy3 zur Kollisionsyermeidung durch Folgen t\ 

Ziel des in Abschniit 6.2 beschriebenen Verfahrens zur Kollisionsvermeidung durch Brems- oder Beschleuni- 
gungsmanover ist es. ein Hindernis mit einem Mindestabstand rnjmjkoHisionsfrei zu passieren. 

. ' . * • • ■ " 

I.-) . 
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Wie in Fig. 16 anschaulich dargestellt und iii Abschnitt 6^ eriautert, konnen Sonderfaile auftreten, bei denen 
das Fahrzeug das Hiademis durch Brems- oder Beschleunigungsmanover nicht passieren kann. In diesen Fallen 
muB das Fahrzeug das Hindemis durch ein Ausweichmandver quer zur Kursrichtung passieren oder das 
Fahrzeug folgt dem Hindernis iinter Einhaltung eines Mindestabstandes rmJnd. 

Urn das Fahrzeug dem Hindernis unter Einbehaltung eines Mindestabstandes rmind folgen zu lassen, wird 
erfindungsgemaB folgendes Verfahren verwandt: 

Mit der Abweichung 

d " rmtnd — ]/(xf — x/^ + (yp — YhY 

des Abstandes vom Mindestabstand rmmd und der momentanen Relati vgeschwindigkeit 

Av ^ VKV— VHQO^(VF— Vfii 

zwischen Fahrzeug und Hindemis in Kursrichtung des Fahrzeuges berechnei die Kollisionsvermeidungseinf ich- 
tung ^ V3 die Beschleunigung ajcva zu 



2d 



"KVi - ■* 



Id 



fur d>d^„, 



fiir d<' d,„, 



^-'laAV-a^d sonst. 

Durch die Umschaltung fiir den Bereich \ rf|<c/u/n werden betragsmaBig extrem hohe bkvz fur d«0 vermie- 
den. 

Die Einrichtung A:V3 (Fig. 20) bestimml cnisprechend dem beschriebencn Verfahren die Beschleunigung 
aKVZ^ EingangsgroBen der Einrichtung KVZ sind die Signale rmind* XF^yRXH^yH. vf, vh, vxv^und v//. 

Der Summierer 709 addiert das im Multiplizierer 705 bestimmte Quadrat der AusgangsgroBe des Summierers 
701 und das im Multiplizierer 707 bestimmte Quadrat der AusgangsgroBe des Sumnfiierers 703, wobei der 
Summierer 701 die EingangsgroBe xh von der EingahgsgroBe xf subtrahiert und der Summierer 703 die 
EingangsgrdBe y// von der EingangsgroBe y/rsubtrahiert. Der Summierer 713 bildei die GroBe </durch Subirak- 
tion der im Wurzelglied 711 gebildeten Quadratwurzel des Ausgangssignals des Summierers 709 von der 
EingangsgroBe /•m/ncA Der Summierer 721 bildet die GroBe ziv^ durch Subtraktion des im Multiplizierer 719 
bestimmten Produktes der EingangsgroBe VHmxi dem Ausgangssignal des Cosinusgliedes 717 von der Eingangs- 
groBe VKV, wobei das Cosinusglied 717 den Cosinus des im Summierer 715 durch Subtraktion der GroBe v^/ von 
der GroBe VFcrmitielten Differenzsignals bestimmt. Der Summierer 727 addiert die im Proportionalglied 723 
mit dem Faktor — multiplizierte GroBe c/zur im Proportionalglied 725 mit dem Faktor ^2a multiplizierten 
GroBe Av, wobei a einen frei vorgebbaren Parameter darstellt. Der Dividierer. 737 dividiert die im Multiplizierer 
729 quadrierie und anschlieBend im Proportionalglied 731 mit dem Faktor 1/2 multiplizierte GroBe ^1 vdurch das 
Ausgangssignal c/des Summierers 713. Das Signal </wird im Summierer 733 zum Parameter —dum addiert und 
im Summierer 735 vom Parameter --dum subtrahiert. Das Ausgangssignal des Summierers 733 ist Steuersignal 
des Schaltgliedes 741, welches bei positivem Steuersignal die im Proportionalglied 739 mit —1 multiplizierte 
AusgangsgroBe des Dividierers 737 und ansonsteh die AusgangsgroBe des Summierers 727 durchschaltet. Das 
Ausgangssignal des Summierers 735 ist Steuersignal des Schaltgliedes 743, welches bei positivem Steuersignal 
das Ausgangssignal des Dividierers 737 und ansonsten das Ausgangssignal des Schaltgliedes 741 als Ausgangs- 
groBe aKV^ der Einrichtung KVZ durchschaltet. 

6.5 Ausfuhrungsbeispiel 1 fur eine Anordnung zur automatischen Kollisionsvermeidung 

Dem Ausfuhrungsbeispiel 1 liegen der Aufbau und die Gesamtstruktur der Fahrzeugfuhrung zugrunde, wie 
sie in Fig. I und 2 dargestellt und in Abschnitt 6.1 bereits erlautert wurden. 

Die Anordnung (Fig. 26) setzt sich im wesentlichen aus den Einrichtungen 5(823), /CP(825), 5(827), /C£(829) 
KV\ (831), KV2 (833), KV3> (835). /?(837) und dem Ausgangsblock KV AUS zusammen. Eingangssignale der 
Anordnung sind die aus der Ebene der Sollbahnvorgabe bzw. der Hinderniserkennung vorgegebenen Groflen 
XF. yp, y^F. VF, rp ATM yH» vh> m an und r/y. Die Eingangssignale werden von den Sample & Hold-Gliedern SOI bis 
821 in AbstSnden zlf abgetastet und iiber einen Zeitschritt/lfkonstant gehalten. 

Der Block 5(823) bestimmt aus der ruckgekoppelten AusgangsgroBe vxvund dem Eingangssigna! v'rdie 
Fahrzeugbeschleuhigung ap Zusammen mit den Signalen xf yp VF vkv. tf xh. yn, m m an und rn ist ap 
Emgangssignal der Vorrichtung KP{Z2S) zur Bestimmung der IColIisionsparameter tat. (Pk und ik. Die Vorrich- 
lung 5(827) ermitteh aus den GroBen q>K. v/rund v/c^vden Mindestabstand tmind^ Aus den EingangsgroBen vk. 
rmmrf und r/c sowie dem Parameter tkrit legt die Einrichtung A^£*(829) zur Kollisionserkennung die Ausgangsgro- 
Be ^^fesi. die bei Kollisionsgefahr den Wen 1 und sonst den Wert — 1 hat. 

Die Kollisio.nsvermeidungseinrichtung KV \ (831) bestimmt aus den EingangsgroBen r„,,>,j. kg, rK, xf yF ^'f. 
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^KVt rp* XHy YH. m und fH sowie den Parametern at* £v und Aa die Beschleunigung aKV\ und die 
Schaltsignaie 5b uhd 

Die Kollisiohsvermeidungseinrichtung a: V2 (833) ermittelt aus den EingangsgrdBen rmind, yp. vf, vkv, ap, 
fK W» YHf m m m w und den Parametern tknu rq^min und rq,mBx die Querpositionsverschiebung r<y» das 
Schaltsignal Si, die Position XKV2tyKV2 und den Kurswinkel vxv2. Die Kollisionsvermeidungseinrichtung KV3 5 
(835) bestimmt aus den EingangsgrbBen rmind» xp, yp, w. yn* Vfi v/a vicv und v// die Beschleunigung ajcK3. Die 
Einrichtung (837) ermittelt aus den GrdBen 5, v/r, vjcv, w urid das Schaltsignal S^, die Position xr, yR und 
den Kurswinkel vr, wobei das Eingangssignal 5der Einrichtung iCV3 Ausgangssignal der Einrichtung KV-AUS 
ist und das Eingangssignal kg \x\ Fig. 24 ersetzt. Samtliche AusgangsgroBen der Einrichtungen KE(%2^\ AT VI 
(831)» KV2 (833), ^V3 (835) und R (837) und zusatzlich die Signale xp, yp, vpxind apsind EingangsgroBen der 10 
Einrichtung KV-AUS, die die AusgangsgroBen S» xkv, yKV, v^vund a a: bestimmt Das Schaltsignal 5wird auf 
deii Eingang der Einrichtung R zurCickgefuhrt. Die AusgangsgroBe v/cvder Anordnung wird durch Aufintegra- 
tion (Integrierer 841) und anschlieBendes Abtasten in Zeitschritten St und Halten tiber einen Zeitschritt At 
(Sample & Hold-Glied 843) aus der GrdBe a/cv gebildet. Die Signale xkv, yKV, vjcv und >icv werden als 
Ausgangssignale der Collisions vermeidungsanordnung an die Ebene der Regeluhg weitergegeben. \s 

Der Aufbau der Einrichtung KV-AUS ist in Pig. 27 dargestellt Das Eingangssignal 5) der Einrichtung 
KV-AUS \st Steuersignal der Schaltglieder 845 und 847, wobei Schaltgiied 845 bei positivem S\ das Eingangssi- 
gnal So und Schaltgiied 847 das Ausgangssignal des Schaltgliedes 845 durchschaltet. Bei negativem S\ schaltet 
Schaltgiied 845 den Wert ^ 1 und Schaltgiied 847 den Wert + 1 durch. Das Ausgangssignal des Schaltgliedes 847 
nimmt den Wert 1 an, wenn S\ negativ ist oder 5i positiv und Sq positiv ist Das Signal 52 ist Steuersignal des 20 
Schaltgliedes 849, welches bei positivem Steuersignal das Ausgangssignal des Schaltgliedes 847 und sonst den 
Wert — 1 durchschaltet Das Signal A^ist Steuersignal des Schaltgliedes 851, welches bei positivem Steuersignal 
das Ausgangssijgnal des Schaltgliedes 849 und sonst den Wert ^1 durchschaltet Das Ausgangssignal * des 
Schaltgliedes 851 ist Ausgangssignal 5 der Vorrichtung KV-AUS, Bei positivem 5 wird die Kollision durch ein 
Ausweichmandver quer zur Kursrichtung vermieden (KV2). Bei negativem Swird tm Falle von Kollisionsgefahr 25 
ein Brems- oder Beschleunigungsmandver durchgefOhrt (KVi, KV3), 5 ist Steuersignal der Schaltglieder 859, 
861, 863 und 853. Bei positivem 5 schaltet Schaltgiied 859 das Signal xkvi, Schaltgiied 861 das Signal yKVi, 
Schaltgiied 863 das Signal v/cv2 und Schaltgiied 853 den Wert — 1 durch. Bei negativem 5 schaltet Schaltgiied 
859 das Signal xp, Schaltgiied 861 das Signal yp, Schaltgiied 863 das Signal v^Fund Schaltgiied 853 das Signal kg 
durch. Das Signal 5b ist Steuersignal der Schaltglieder 855 und 857, wobei das Schaltgiied 855 bei positivem So 30 
den Wert —I und sonst das Ausgangssignal des Schaltgliedes 853 durchschaltet und Schaltgiied 857 bei 
positivem 5b das Ausgangssignal des Schaltgliedes 853 und sonst den Wert — 1 durchschaltet Das Ausgangssi- 
gnal des Schaltgliedes 853 steuert Schaltgiied 865, welches bei positivem Steuersignal das Signal aKV\ und sonst 
das Signal a^ durchschaltet. Das Ausgangssignal des Schaltgliedes 857 steuert das Schaltgiied 867, welches bei 
positivem Ste;uersignal das Signal ajcva und sonst das Ausgangssignal des Schaltgliedes 865 durchschaltet Das 35 
Eingangssignal 53 ist Steuersignal der Schaltglieder 869, 871 und 873, wobei bei positivem Si vom Schaltgiied 869 
das Signal xr, vom Schaltgiied 871 das Signal y;? und vom Schaltgiied 873 das Signal vr und bei negativem 53 vom 
Schaltgiied 869 das Ausgangssignal des Schaltgliedes 859, vom Schaltgiied 871 das Ausgangssignal des Schalt- 
gliedes 861 und vom Schaltgiied 873 das Ausgangssignal des Schaltgliedes 863 durchgeschaltet werden. 

Die Beschaltung der Schaltglieder 845, 847 und 849 ist so gewahit, daB ein Ausweichmandver quer zur 40 
Kursrichtung nur dann durchgefuhrt \yird. wenn S2 positiv ist (d. h. es stehi ein genugend groBes Intervall Irq^min, 
rq,max]i fur seitliche Ausweichmandver zur Verfugung) und wenn eine Kollision durch Brems- oder Beschleuni- 
gungsmandver nicht vermieden werden kann ^5r negativ) oder das Hindemis hierbei nicht passiert wird (S) 
positiv und 5b positiv). Ansonsten wird eine Kollision durch Brems- oder Beschleunigungsmandver vermieden. 

Durch Abanderung der Einrichtung KV-AUS dtrgesialu daB die Schaltglieder 845, 847 und 849 ersatzlos as 
wegfallen und die EingangsgrdBe S2 direkt auf den Eingang des Schaltgliedes 851 geschaltet ist, wird eine 
Kollision bei positivem 52 immer durch ein seitiiches Ausweichmandver vermieden. . 

6.6 Vereinfachtes Verfahren und Einrichtung zur KoHisionsvermeidung 

50 

Mit Hilfe des in Abschnitt 6.1.2 beschriebenen Verfahrens, das der Einrichtung KP {Fig. 13) zugrunde liegi, 
werden die noch verbleibende Zeit tK bis zur cngsten AniiSherung zwischen Fahrzeug und Hindernis sowie der 
Abstand fk und der Winkel (pK der engsten AnnSherung bestimmt Anhand der GrdBen r/^ und tK legt die 
Einrichtung ATEzur Kollisionserkennung unter Berucksichtigung des Mindestabstandes rm/nc/ und der Zeitkon- 
stanten fitr// die GrdBe /r^fesi, die angibt ob Kollisionsgefahr besteht . 55 

Dem vereinfachten Verfahren zur Kollisionsvermeidung liegt die Idee zugrunde, die Einhaltung des Mindest- 
abstandes Tm/wzum Zeitpunkt der engsien AnnSherung dadurch zu sichern, daB die Sollposition des Fahrzeugs 
innerhalb der noch verbleibenden Zeit (k gcgenuber der ursprunglichen Sollposition um die Lange 

Ar = rmind — rK .60 

in Richiung des Winkels (pK verschoben wird. Durch die Positionsverschiebung unter dem Winkel (pfc wird die 
Lage in genau der Richtung geandert, die die groBte Verbesserung des Absiandes der engsien Annaherung 
erwarten laBt. Im Gegensatz zu der Positionsverschiebung quer zur Sollbahn. wie sie in Abschnitt 6.3 beschrie- 
ben wird, ist bei einer Positionsverschiebung unter dem Winkel g>K auch ein Anieil langs zur Kursrichtung 65 
enthalien. Die Verschiebung um ^iir geschieht in einem stetigen Obergang miitels einer Gewichiungsfunktion 
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gOA) - 2 



( km ) ( hri, ) 



FUr die iieue Sollposition ergibt sich 



XKVA = Jr/r + g(tK) Ar cos (pK 
YKVA YF-^- ^tj^ArsxTi q>K 



Der neue Kurswinkel ergibt sich mit 



gy = 




) 



aJs 



I'jTM arclan 



Vfcycos vp-^ A rgy cos <Pk 



Die Einrichtung KV4 zur Kollisionsvermeldung nach dem beschriebenen Verfahren ist in Fig. 28 dargestellt. 
Der Summierer 901 bildet die GroBe Ar, indem er das Eingangssignai fk vom Eingangssignal rmind subtrahiert. 
Die GroOe Ar wird im Muitiplizierer 903 mit dem Ausgangssignal g und im Multiplizierer 905 mit dem 
Ausgangssignal ^vdes Obertragungsgliedes 902 vom Typ Block 2.2 tnultipliziert, wobei das Obertragungsglied 
902 in der in Fig. 2.2 dargestellten und in Abschnitt 63 beschriebenen Weise aufgebaut ist und als Eingangsgro- 
Oen das Signal tK und den Parameter tkrit besitzt. Die AusgangsgroBe fkva des Mulliplizierers 903 wird im 
Multiplizierer 915 mit dem im Sinusglied 907 bestimmten Sinus der EingangsgroBe (pK und im Multiplizierer 917 
mit dem Cosinusglied 909 bestimmten Cosinus des Winkels cpK mullipliziert. Entsprechend wird die Ausgangs- 
groBe VKVA des Multiplizierers 905 im Multiplizierer 919 mit dem Sinus des Winkels (pK und im Multiplizierer 
921 mit dem Cosinus des Winkels ^jc multipliziert. Das Eingangssignal vicvwird im Multiplizierer 923 mit dem im 
Sinusglied 911 gebildeten Sinus des Winkels v/rund im Multiplizierer 925 mit dem im Cosinusglied 913 gebildeten 
Cosinus des Winkels v^multipliziert Im Summierer 927 wird die GrdBe ykva durch Addition des Ausgangssi- 
gnals des Multiplizierers 915 und des Eingangssignals >r bestimmt. Entsprechend bestlmmt der Summierer 929 
die Gr6Be xkva durch Addition des Ausgangssignals des Multiplizierers 917 und des Eingangssignals xf. Das 
Arcustangensglied 935 ermittelt den Winkel vkva mit dem Ausgangssignal des Summierers 931 als Gegenkathe- 
te und dem Ausgangssignal des Summierers 933 als Ankathete. wobei der Summierer 931 das Ausgangssignal 
des Multiplizierers 923 zum Ausgangssignal des Multiplizierers 919 addiert und der Summierer 933 das Aus- 
gangssignal des Multiplizierers 925 zum Ausgangssignal des Multiplizierers 921 addiert 

Nachdem das Fahrzeug das Hindernis mit einer um Ar unter dem Winkel (pK verschobenen Position im 
Sicherheitsabstand r/ny„</ passiert hat. fuhrt eine Einrichtung /?4 die Sollposition des Fahrzeuges in einem 
stetigen Obergang innerhalbder Zeit trock auf die urspriingliche SoUbahn zurOck. Dazu wird zum Zeitpunkt der 
engsten Annaherung, d, h. wenn fjc negativ wird und kg\ox\ 1 auf — 1 umschaltet, die augenblickliche Positions- 
verschjebung gleich rKVA^umd^r Sollposition und der augenblickliche Winkel ^x: gleich (pK^um gespei- 

chert. Wahrend der Zeitspianne track nach dem Zeitpunkt der Umschaltung der GroBe kg, der ohne Beschran- 
kung der AUgemeinheit der folgenden Betrachtungen als gleich Null betrachtet wird, bestimmt die Riickfuhrein- 
richtung i? 4 die Sollposition -sr^e 4t 4 und den Sollkurswinkel ^//^ 4 wie folgt: 



Emgahgssignale der Einrichtung R 4 (Fig. 29) zur Riickfuhrung der Fahrzeugsollposiiion auf die ursprungliche 
Sollbahn sind die AusgangsgroOen fkva und (pKVA der Einrichtung die AusgangsgroBe kgd^r Einrichtung 

KE und die Signale vf. vkv. x/t und yp- Das Eingangssignal kg wird im Toizeitglied 937 um die Zeitspanne triick 



XRA = XF+ g(t)rKVA,umCOS ((pK,um) 
• VR 4 =? + g(t)rKVA,um sin (tpK^um) 
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verzogert Die GroBe kg ist Steuersignal des Schaltgliedes 939, das bei positivem kg den Wert 0 und sonst den 
Wen 1 durchschaltcL Das Ausgangssignal des Totzeitgliedes 937 steuert das Schaltglied 941, das bei positivem 
Steuersignal das Ausgangssignal des Schaltgliedes 939 und sonst den Wert 0 durchschaltet Das mit bezeich- 
nete Ausgangssignal des Schaltgliedes 941 nimmt nach dem Umschalten der GroQe Z:^ von + 1 auf —1 ftir eine 
Zeitspanne trock den Wert 1 an und hat sonst den Wert Null Mit der positiven Flanke des Ausgangssignals des s 
Schaltgliedes 941 wird der Intergrierer 943 auf den Wert 0 gesetzt und das Sample 8c Hold-Glied 949 tastet das 
Signal FKVA ab und halt den augenblicktichen Wert rKVA,um bis zur n^chsten Flanks. Entsprechend tastet das 
Sample & Hold-Glied 951 bei positiver Flanke des Signals 54 die EingangsgroBe ^jcab und halt den augenblickli- 
chen Wert ^jct//n bis zur nachsten positiven Flartke. Der Integrierer 943 integriert das Ausgangssignal des 
Schaltgliedes 941 auf. Der Summierer 945 subtrahiert das Ausgangssignal des Integrierers 943 vom Parameter lo 
trQdi' Die Grofle rKVA,um wird im Multiplizierer 959 mit dem Ausgangssignal g und irn Multiplizierer 961 mit dem 
Ausgangssignal #v des Obertragungsgliedes 947 vom Typ Block 2^ multipliziert, wobei das Obertragungsglied 
947 in der in Fig. 22 dargestellten und in Abschnitt 63 beschriebenen Weise aufgebaut ist und als Eingangsgrd- 
Ben das Ausgangssignal des Summierers 945 und den Parameter trcck besitzt Die AusgangsgrdBe des Muitipli- 
zierers 959 wird iiii Multiplizierer 963 mit dem im Sinusglied 955 bestimmten Sinus der Gr5Be fKum und im 15 
Multiplizierer 965 mit dem im Cosinusglied 957 bestimmten Cosinus der Gri&Be q>K,um multipliziert Entspre- 
chend wird die AusgangsgroBe des Multiplizierers 961 im Multiplizierer 967 mit dem Sinus der GroBe q>K,um und 
im Multiplizierer 969 mit dem Cosinus der GroBe (pK^um multipliziert Das Eingangssignal KATvwird im Multipli- 
zierer 983 mit dem im Sinusglied 979 gebildeten Sinus des Winkels vf und im Multiplizierer 985 mit dem im 
Cosinusglied 981 gebildeten Cosinus des Winkels multipliziert Im Summierer 971 wird die GroBe yR4 durch 20 
Addition des Ausgangssignals des Multiplizierers 963 und des Einga[ngssignals yp bestimmt Entsprechend 
bestimmt der Summierer 973 die Grd&e xra durch Addition des Ausgangssignals des Multiplizierers 96Sund dies 
Eingangssignals xp- Das Arcustangensglied 987 ermittelt den Winkel vra mit dem Ausgangssignal des Summie- 
rers 975 als Gegenkathete und dem Ausgangssignal des Summierers 977 als Ankathete, wobei ider Summierer 
975 das Ausgangssignal des Multiplizierers 967 vom Ausgangssignal des Multiplizierers 983 subtrahiert und der 25 
Summierer 977 das Ausgangssignal des Multiplizierers 969 vom Ausgangssignal des Multiplizierers 985 subtra- 
hiert 

6.7 Ausftihrungsbeispiel 2 fur eine Anordnung zur automatischen Kollisionsvermeidung 

• 30 

Dem Ausfuhrungsbeispiel 2 liegen der Aufbau und die Gesamtstruktur der Fahrzeugfuhrung zugrunde, wie 
sie in Fig. 1 und 2 dargestellt und in Abschnitt 6.1 bereits eriautert wurden. 

Die Anordnung (Fig. 30) setzt sich im wesehtlichen aus den Einrichtungen ^(1021), KP(1023), 5(1027), KE 
(1025). KV^ (1029), R 4 (1031) und dem Ausgangsblock KVA-AUS zusammen. Eingangssignale der Anordnung 
sind die aus der Ebene der Sollbahnvorgabe bzw, der Hinderniserkennung vorgegebenen GroBen xf^YR vf, vr 35 
rR XH, yn, m m a/y und r//. Die Eingangssignale werden von den Sample & Hold-Gliedern 1001 bis 1019 in 
Abstanden zl/abgetastet und uber einen Zeitschritt id/konstantgehallen. 

Der Block S (1021) bestimmt aus der ruckgekoppelten AusgangsgroBe v/cvund dem Eingangssignal v^die 
Fahrzeugbeschleunigung a^. Zusammen mit den Signalen xf» yp, vf, vkv, rp, xu yn, v//, v>/, an und m ist ap 
Eingangssignal der Einrichtung ATP (1023) zur Bestimmung der Kollisionsparameter rjc. <pK und tK- Die Einrich- 40 
tung 5(1027) ermittelt aus den GroQen ipK* VFund rjcvden Mindestabstand rm/nrf Aus den Eingangsstufen r/c, 
rmwdund fjcsowie dem Parameter awrlegt die Einrichtung KE{\025)zur Kollisionserkennung die Ausgangsgro- 
Be kg f^si, die bei Kollisionsgefahr den Wert 1 und sonst den Wert — 1 hat 

Die Kollisionsvermeidungseinrichtung\fiCV4 (1029) bestinrimt aus den Eingangsgrdflen rjc, v/c, tK, rmind> xr yp, . 
VF, v/cvund aFdie Positionsverschiebung 4r, die Position Jifjcv4,yjcv4 und den Kurswinkel VJCV4. 45 

Die Einrichtung /? 4 (1031) ermittelt aus den GroBen Ar, (pfc kg, xpyR vr v/cKund aFdas Schaltsignal 54, die 
Position A^/?4,y;?4 und den Kurswinkel v/?4. Samtliche AusgangsgroBen der Einrichtungen ^£*(1025), /CV4(1029) 
und 4 (1031) und zusatzlich die Signale xf, yF und vps\nd EingangsgroBen der Einrichtung ^V4->4L/5, die die 
AusgangsgroBen xkv, ykvy^nd v/cv bestimmt Die AusgangsgroBe v^^vder Anordnung wird dufch Aufintegra- 
lion (Integrierer 1035) und anschlieBendes Abtasten in Zeitschritten At und Halten uber e'men Zeitschritt 50 
(Sample & Hold-Glied 1037) aus der AusgangsgroBe aFder Einrichtung B gebildet Die Signale xkv* yKV* vkv 
und w/^v werden als Ausgangssignale der Kollisionsvermeidungsanordnung an die Ebene der Regelung weiter- 
gegeben. 

Der Aufbau der Einrichtung 4-/4 1/5 (1033) ist in Fig. 31 dargestellt. EingangsgroBen der Vorrichtung 
KVA'AUS sind die Signale kg, yKVA. xkva. vkva. Sa, Yra, xra und v/>?4. Das Eingangissignal 54 steuert die 55 
Schaltglieder 989, 991 und 993, wobei bei positivem Sa Schaltglied 989 die GroBe xr 4, Schaltglied 991 die GroBe 
yRA und Schaltglied 993 die GroBe vra und bei negativem 54 Schaltglied 989 die GrdBe xp Schaltglied 991 die 
GroBe yFund Schaltglied 993 die GroBe vf durchschaltet Das Eingangssignal Ar^ steuert die Schaltglieder 995, 
997 und 999,. wobei bei positivem kg Schaltglied 995 die GrdBe xkva, Schaltglied 997 die GroBe ykva und 
Schaltglied 999 die GroBe vkva durchschaltet Bei negatiyein /r^schaltet Schaltglied 995 das Ausgangssignal von 6C 
Schaltglied 989, Schaltglied 997 das Ausgangssignal von Schaltglied 991 und Schaltglied 999 das Ausgangssignal 
von Schaltglied 993 durch. 

Patentanspruche 

\ . '■ hi 
\. Verfahren zur automatischen Kollisionsvermeidung fur automatisch fiihrbare Fahrzeuge, gekennzeich- 
net durch ein hierarchisch strukturieries Verfahren fur Echtzeitbetrieb. bei dem aus den gegebenenfalls 
vom Fahrer vorgegebenen Sollsignalen bzw. -groBen fur den SoH-Kurswinkel und die Soll-Geschwindigkeit 
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und aus den uber eine sonsorische Fahrbahn- und Fahrzeugerfassung erfaBten Signalen und Daten ia einer 

ersten Hierarchiestufe die aktuellen Spllsignalen und Solldaten beispieisweise uber die Sollposition, den 

Sollkurswinkel, die SoUgeschwindigkeit, die Soilbeschleunigung und yorzugsweise den KrUmmungsradius 

beziiglich der extrapolierten Sollbahn des Fahrzeuges erzeugt und diese Soltsignale und -daten und die 

durch am Fahrzeug angebrachten Sensoren ermitteUen und/oder ganz oder teilweise durch eine externe 

Einrichtung mittels Dateniibertragung zum Fahrzeug ubermittelten und/oder ganz oder teilweise aus der 

zeitlichen Anderung der Fahrzeugsollposition und der Hindernisposition bestimmten aktuelJen Daten liber 

die Position, den Kurswinkel, die Geschwindigkeit, die Beschleunigung und vorzugsweise den Krummungs- 

radius der Bahn eines Hindernisses an eine eine KoIUsionsvermeidung bewirkende zweite Hierarchiestufe 

weitergeleitet werden, in der anhand der vorgegebenen Signale bzw. Daten die Bahn des Hindernisses und 

die Sollbahn des Fahrzeuges yorausschauend extrapoHert und der Zeitpunkt und der Abstand der engsten 

Annaherung zwischen dem Fahrzeug und dem Hindernis sowie gegebeiienfalls zusatzlich der Winkel der 

engsten Anniherung auf den extrapolierten Bahnen bestimmt und ermittelt werden, wobei anhand der noch 

verbleibenden Zeit bis zur engsten Annaherung und des Abstandes der engsten Annaherung eine eventuelle 

Kollisionsgefahr anhand von vorwahlbaren Parametern feststellbar ist und in Abhangigkeit davon Kolii- 

sionsvermeidungs-Sollsignale und -daten fur eine gegebenenfalls ge^nderte KoJIisionsvermeidungs-Sollpo- 

sition und einen gegebenenfalls geSnderten KoUisionsvermeidungs-Sollkiirswinkel oder die Kollisionsver- 

meidungs-Sollgeschwindigkeit und die -Soilbeschleunigung derart erzeugt werden, daQ das Fahrzeug das 

Hindernis unter Einhaltung eines Mihdestabstandes durch Einleitung eines Brems- oder Beschleunigungs- 

mandvers, durch Oberfiihrung in eine seitlich von der eigentlichen Soltbahn abweichende kollisionsfreie 

Sollbahn passiert oder dem Hindernis unter Einhaltung eines Mindestabstandes folgt, wobei die ursprDngli- 

chen oder die im Fall einer Kollisionsgefahr vertnderten Kollisionsvermeidungs-Sollbahnsignale bzw. 

-daten einer Einrichtung zur Fahrzeugregelung als dritte Hierarchiestufe zugefiihrt werden, Qber die die 

Stellglieder fur die Lenkung und/oder den Antrieb und die Bremsanlage des Fahrzeuges betatigt werden. 

2. Verfahren nach Anspruch 1, dadurch gekennzeichnet, daB zur Bestimmung der noch verbleibenden 
Zeitspanne bis zur engsten Annaherung des Fahrzeuges und des Hindernisses eine Extrapolation des 
zukunftigen Verlaufes der Sollbahn des Fahrzeuges und der Hindernisbahn in einem vereinfachten Verfah- 
ren derart erfolgt.. daB die Fahrzeugsollposition und die Hindernisposition aus ihrer augenblicklichen Lage 
ohne Berucksichtigung der Anderung des Kurswinkels auf geradenformigen Bahnen bei konstanter Be- 
schleunigung extrapoHert und daB die Zeitspanne bis zur engsten Annaherung als Zeitspanne bis zum 
Erreichen des n^chstliegenden zukunftigen Minimums des Abstandes zwischen Fahrzeug und Hindernis auf 
den extrapolierten Bahnen bestimmt werden, wobei bei sich rechnerisch ergebenden mehreren zeitliche 
aufeinander folgenden minimalen Abstanden das zeitlich nachstliegende Abstandsminimum den Abstand 
der engsten Annaherung und der Winkel dieses Abstandsminimums zu einem ortsfesten Bezugssystem als 
Winkel der engsten Annaherung zur entsprechenden Ermittlung und Beeinflussung der Soil- bzw. ICoili- 
sionsvermeidungs-SoUsignale bzw. -daten eingehen. 

3. Verfahren nach Anspruch 2, dadurch gekennzeichnet, daB zur naherungsweisen Bestimmung der noch 
verbleibenden Zeitspanne bis zur engsten Annaherung zwischen Fahrzeug und Hindernis zusatzlich die 
aktuellen Signale bzw: Daten der in der ersten Hierarchiestufe ermittelbaren Kriimmungsradien der Fahr- 
zeugsollbahh und die aktuellen Signale bzw. Daten der Hindernisbahn der zweiten Hierarchiestufe zur 
kreisbogenformigen Extrapolation der Fahrzeugsollbahn und der Hindernisbahn zugefOhrt werden, wobei 
das fur die geradenfdrmige Extrapolation der Fahrzeugsollbahn und der Hindernisbahn zugrundegelegte 
Verfahren zur Bestimmung des Zeitpunktes der engsten Annaherung beziiglich eines fiktiven Fahrzeuges 
und eines fiktiven Hindernisses auf geradenformigen Tangentenbahnen an den kreisformigen Extrapolatio- 
nen der Fahrzeugsollbahn und der Hindernisbahn durchgefuhrt wird, wobei die Signale bzw. Daten fur die 
Sollgeschwindigkeit des fiktiven Fahrzeuges und die Geschwindigkeit des fiktiven Hindernisses den Ge- 
schwindigkeiten des realen Fahrzeuges und des realen Hindernisses entsprechen und die Tangentenbahn so 
an die kreisformigen Bahnexirapolationen angelegt werden. daB sich das fiktive Fahrzeug und das reale 
Fahrzeug bzw. das fiktive Hindernis und das reale Hindernis zu einem aus der Kollisions-Vorgeschichte 
bekannten Zeitpunkt der zu erwartenden engsten Ann^herung^ zwischen Fahrzeug und Hindernis im 
jeweiligen BerOhrungspunkt der kreisformigen Bahnextrapolaiion und der Tangentenbahn treffen, und die 
so ermittelte.verbleibende Zeitspanne bis zur engsten Annaherung in die Ermittlung der gegebenenfalls 
veranderten Sollsignale bzw. -daten zur Ansteuerung der Fahrzeugregelung eingeht. 

4. Verfahren nach einem der Anspriiche 1 bis 3, dadurch gekennzeichnet, daB in einem Verfahrensschriit die 
ermittelte Zeitspanne bis zur extrapolierten engsten Annaherung des Fahrzeuges und des Hindernisses mit 
einer vorgebbaren kritischen Zeitspanne und in einem weiteren Verfahrensschriti die extrapolierte engste 
Annaherung zwischen dem Fahrzeug und dem Hindernis mil einem Mindestabstand verglichen werden, und 
daB Kollisionsvermeidungs-Sollsignale bzw. -daten zur Anderung des an sich ermittelten Sollkurses des 
Fahrzeuges nur dann erzeugt werden. wenn die extrapolierte Zeitspanne kleiner ist als die yorgegebene 
kritische Zeitspanne und gleichzeitig der exirapolierte Abstand der engsten Annaherung kleiner ist als der 
vorgebbare Mindestabstand. 

5. Verfahren nach Anspruch 4, dadurch gekennzeichnet, daO die vorgebbare Zeitspanne und der vorgebbare 
geringste kritische Mindestabstand im nachfolgenden Steuerungszyklen um einen bestimmten Wert ver- 
groBert werden, wenn in der vorzugsweise unmiitelbar zurucklicgendcn Steuerungsphase bcreits eine 
Kollionsgefahr feststellbar war. 

6. Verfahren nach einem der Anspriiche 1 bis 5. dadurch gekennzeichnet, daB bei festgestellter FCollosiohs- 
gefahr eine gezieltc Anderung der Soilbeschleunigung und der Sollgeschwindigkeit zur aus der ersten 
Hierarchiestufe gegebenen Beschleunigung des Fahrzeuges derart durchgefuhrt wird. daB das Fahrzeug 
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das Hindernis unter Einhaltung des Mindestabstandes passiert. wobei jeweils der extrapolierte zu erwarten- 
de Abstand zum Zeitpunktder engsten Annaherung sowie die Anderung des extrapolierten zu erwartenden 
Abstandes der engsten Annahe.rung jeweils bei einer Anderung der in der Kollisions-Vorgeschichte ermit- 
teite.n Sollbeschleunigung urn einen frei vorgebbaren Betrag bei der Bestimmung der neuen geanderten 
Sollbeschleunigung so eingeht, daO ein grdBerer oder zumindest ein gleicher Abstand ats der Mindestab- 5 
stand beziiglich der engsten Ann&herung erzielbar ist, wozu die Sollgeschwindigkett durch Integration der 
Sollbeschleunigung bestimmt wird. 

7. VerCahren nach einem der AnsprQche I bis 4, dadurch gekennzeichnet, daB bei festgestellter Kolhsionsge- 
fahr Kollisiorisvermeidungs-Sollsignale bzw. -daten fOr die Fahrzeugregelung mit einer gezielten Verschie- 
bung der Fahrzeugspllposition quer zur Sollkursrichtung und eine entsprechende Anderung des Sollkurs- 10 
winkels des Fahrzeuges zur Passierung des Hindernisses unter Einhaltung des Mindestabstandes erzeugt 
werden, wobei aus der Extrapolation des zu erwartenden Abstandes der engsten Annaherung aus der 
ursprunglichen aktuellen Sollposition des Fahrzeuges heraus und aus der Extrapolation des zu erwartenden 
Abstandes der ensten Annaherung aus einer in der Kollisions-Vorgeschichte bestimmten verschobenen 
Sollposition des Fahrzeuges heraus eine neue Verschiebung der Sollposition des Fahrzeuges ermittelt wird» 15 
aus der heraus ein Abstand mit einer engsten Annaherung zwischen Fahrzeug und Hindernis erzielbar ist. 
der groBer oder gleich dem vorwahlbaren Mindestabstand ist . . 

8. Verfahren nach Anspruch 7, dadurch gekennzeichiiet, daB nach OberfOhrung der Sollposition des Fahr- 
zeuges durch die ermittelten Kollisions-Vermeidungs-Sollsignale bzw. -daten in einem stetigen Obergang 

bis zum Zeitpunkt der engsten Annaherung aus der ursprOnglichen in eine seitliche verschobene/ eine 20 
Kollision vermeidende Lage ab dem Zeitpunkt der engsten Annaherung die Sollposition des Fahrzeuges in 
einem umgekehrten stetigen Obergang auf die ursprQngliche Fahrzeug-Sollbahn durch entsprechend ermit- 
telte Sollsignale bzw. -daten zurOckgef Qhrt wird, 

9. Verfahren nach einem der Anspriiche 1 bis 4. dadurch gekennzeichnet» daB die Sollbeschleunigung und die 
Sollgeschwindigkeit des Fahrzeuges in einer Anordnung so verSndert werden» daB das Fahrzeug dem 25 
Hindernis unter Einhaltung eines Mindestabstandes folgt, wobei die Sollbeschleunigung aus dem Abstand 

des Fahrzeuges zum Hindernis und aus der Relativgeschwindigkeit zwischen Fahrzeug und Hindernis 
bestimmt und die Sollgeschwindigkeit durch Integration der Sollbeschleunigung gebildet wird. 

10. Verfahren nach Anspruch 6» dadurch gekennzeichnet, daB bei festgestellter Kollisionsgefahr und ent« 
sprechend erzeugten Kollisionsvermeidungs-Sollsignalen bzw. -daten vor Ansteuerung der Stellglieder der 30 
Fahrzeugregelung diese Kollisionsvermeidungs Sollsignale bzw. -daten mit zulassigen. durch die physikali- 
schen iind tfechnisch bedingten Grenzen des Fahrzeuges vorgegebenen Beschleunigungssignalen bzw. 
-daten verglichen und nur bei irinerhalb dieses Zulassigkeitsbereiches liegenden Sollsignalen bzw. -daten 

zur Ansteuerung der Stellglieder der Fahrzeugregelung fretgegeben werden. 

11. Verfahren nach Anspruch 7. dadurch gekennzeichnet daB bei festgestellter Kollisionsgefahr und ent- 35 
sprechend erzeugten Sollsignalen bzw. -daten zur Sollpositionsverschiebung quer zur Sollkursrichtung 
diese Sollsignale bzw. -daten mit Signalen und Daten zur Oberpriifung eines Zulassigkeitsbereiches vergli-. . . 
chen und nur bei innerhalb dieses Zulassigkeitsbereiches liegenden Werten an die Stellglieder der Fahr- . 
zeugregelung weitergegeben werden, wobei die Signale und Daten fur den Zulassigkeitsbereich durch den 
seitlich links und rechts der Sollbahn zur Verfugung stehenden Raum festgelegt und beispielsweise in 40 
Abhangigkeit der Fahrbahhbreite fest vorgebbar sind. 

12. Verfahren nach einem der Ahspruche 1 oder 4 oder 9, dadurch gekennzeichnet, daB der bei der 
Ermittlung der Sollsignale: zur Ansteuerung der Stellglieder der Fahrzeugregelung zugrundegelegte Min- 
destabstand bei der engsten Annaherung zwischen Fahrzeug und Hindernis, in Abhangigkeit anderer 
dynamischer GroBen, wie beispielsweise der Fahrzeuggeschwindigkeit oder des Winkels der engsten Anna- 45 
herung, alsveranderbareSignalgroBegewichtet wird. ... 

13. Verfahren nach Anspruch 7. dadurch gekennzeichnet. daB die Sollposition des Fahrzeuges in emem . . 
stetigen Obergang in eine um die Differenz zwischen dem Mindestabstand und dem Abstand der engsten 
Annaherung in Richtung des Winkels der engsten Annaherung verschobene Lage in einem stetigen Ober- 
gang Uberftihrt wird. -^'^ 

14. Vorrichtung zur Durchfiihrung des Verfahrens nach einem der Anspriiche 1 bis 13. dadurch gekenn- 
zeichnet, daB eine Einrichiung AlPzur Bestimmung der Zeitspanne bis. zur engsten Annaherung zwischen 
einem Fahrzeug und einem Hindernis sowie. des Abstandes und des Winkels zum Zeitpunkt der engsten. 
Annaherung miltels Extrapolation der Fahrzeugsollbahn und der Hindernisbahn ausgehend von den Ein- . 
gangssignalen Sollposition, Sollkurswinkel, Sollgeschwindigkeit. Sollbeschleunigung und vorzugsweise ^ .55 
Sollbahnkrummungsradius des Fahrzeuges sowie den Signalen Position. Kurswinkel, Geschwindigkeil, 
Beschleunigung und vorzugsweise Bahnkrummungsradius des Hindernisses oder davon hergeleiteter Si- 
gnalgroBen bzw, -daten vorgesehen ist, wobei alle Signale zuvor in vorzugsweise aquidistanten Zeitschrit- 

len abtastbar und uber zumindest einen Zeitschritt (constant haltbar sind. und daB eine Sensoreinrichiung , 
zur Ermittlung der Sollbeschleunigung oder eine Einrichtung 5 zur Herleitung der Sollbeschleunigung aus so 
der sensorisch erfaBbaren aktuellen Sollgeschwindigkeit und der in einem vorausgehenden, vorzugsweise 
letzten Zeitschritt der Vorrichtung verarbeiteten Sollgeschwindigkeit ermittelbar ist. und daB ferner eine 
Einrichtung KE zur Festsiellung und zum Anzeigen der Kollisionsgefahr in Abhangigkeit der Zeitspanne 
bis zur engsten Annaherung und des Abstandes der engsten Annaherung vorgesehen ist, und daB zumindest 
eine Kollisionsvermeidungs-Einrichtung KVi und/oder und/oder KV3 zur fCollisionsvermeidung 65 

allein durch ein Beschleunigungs- oder Bremsverfahren, durch Erzeugung einer KollisionsvermeidungS: 
Sollbahn abweichend von der ansonsten unveranderten Sollbahn unter Passieren des Hindernisses unter 
Einhaltung eines Mmdestanstandes oder durch Folgen des Hindernisses unter Einhaltung eines Mindestab- 
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standes ohne seitliche Abweichung von der Sotlbahn vorgesehen ist. 

15. Vorrichtung nach Anspruch 14, dadurch gekennzeichnet, daB ferner eine Einrichtung R zu einer stetigen 
Rtickftihrung der Soliposition und des Sollkurswinkels auf die ursprOngliche Sollbahn nach DurchfQhrung 
eines yorausgegangenen Kollisionsvermeidungsmandyers ab dem Zeitpunkt der eng^sten Annaherung vor- 
gesehen ist. 

16. Vorrichtung nach Anspruch 14 oder 15, daddrch gekennzeichnet, dafi die Einrichtung KVt, KV2 und 
^V;3 und vorzugsweise die Einrichtung R parallel arbeiten und ihre Ausgange mit der Einrichtung KV- 
i4 £75 verbunden sind, welche bei angezeigter Kollisionsgefahr abh^ngig von der ZulStssigkeit der seitlichen 
Positionsverschiebungen'die ursprunglichen SollgrdBen ftir die Position und den Kurswinkel des Fahrzeu- 
ges durch die von der Einrichtung KV2 bzw. R neu bestimraten Sollwerte ersetzt oder die urspriingliche 
Sollbeschleunigung abhangig von deren Zui^ssigkeit durch die von der Einrichtung KV\ oder von der 
Einrichtung /iCV3 neu bestimmte Sollbeschleunigung ersetzt. 

17. Vorrichtung nach Anspruch 14, dadurch gekennzeichnet, daB die Einrichtung /CP eine Einrichtung (1.1) 
umfaBt, mit der aus den Eingangsstgnalen xpt yp. vf, vkv, bf, W. yH» m v/y und andie Koeffizienten ci, Ci und 
Cb der kubischen Gleichung 

, ' • - » » • 

tj^ + C2 tic' + Ci tJC + C^ = 0 

zur Ermittlung des Zeitpiinktes tjc der engsten Annaherung so bjldbar sind, daB gilt 

ax* + a/ , . 

indent in der Einrichtung (1.2) die kubische Gleichung auf eine reduzierte kubische Gleichung transformier- 
bar und in einer Einrichtung (1.3) die Nullstellen der reduzierten kubischen Gleichung bestimmbar und auf 
die ursprungliche kubische Gleichung zunicktransformierbar sind, und daB in einer Einrichtung (1.4) aus den 
Niiilstellen der kubischen Gleichung und der in der Einrichtung (l.l) gebildeten Zeitspanne bis zur engsten 
Annaherung im Falle einer uiibeschleunigten Relativbewegung zwischen dem Fahrzeug und dem Hindernis 
die relative Zeitspanne bis zur engsten Annaherung bestimmbar ist 

18. Vorrichtung nach Anspruch 17, dadurch gekennzeichnet daB aus der ermittelten relevanten Zeitspanne 
bis zur engsten Annaherung eine nachgeordnete Einrichtung (1.5) zum einen fur das Fahrzeug wie fur das 
Hindernis die wahrend der Zeitspanne bis zur engsten Annaherung zuruckgelegte Strecke und der Kurs- 
winkel zum Zeitpunkt der engsten Annaherung, in einer Einrichtung (1.6) fiir das Fahrzeug und das 
Hindernis die zum Zeitpunkt der engsten Annaherung zu erwartende Position, in einer Einrichtung (1.7) der 
Abstand zwischen Fahrzeug und Hindernis zum Zeitpunkt der engsten Annaherung und der Winkel des 
Abstandes bezogen auf ein festes Koordinatensystem ermittelbar ist 

19. Vorrichtung nach einem der Ansprtiche 14 bis 18, dadurch gekennzeichnet, daB mittels der Einrichtung 
/C£ eine Kollisionsgefahr anzeigbar ist, wenn die Zeitspanne. bis zur engsten Annaherung kleiner istals das 
Produkt der frei vorgebbaren kritischen Zeitspanne mit einem Gewichtungsfaktor und wenn der Abstand 
der engsten Annaherung kleiner ist als das Produkt des Mindestabstandes mit dem Gewichtungsfaktor, 
wobei der Gewichtungsfaktor den Wert I hat wenn im vorhergehenden Zeitschritt keine Kollisionsgefahr 
angezeigt wurde und einen Wert groBer I hat. wenn im vorhergehenden Zeitschritt Kollisionsgefahr 
angezeigt wurde, und wobei der Mindestabstand als konstante GroBe oder durch eine Einrichtung 5 als in 
Abhangigkeit von anderen GroBen veranderbare GroBe vorgebbar ist 

20. Vorrichtung nach einem der AnsprOche 14 bis 19, dadurch gekennzeichnet daB die Einrichtung KVi 
zwei Einrichtungen ^PumfaBt, von denen eine Einrichtung ATP den zu erwartenden Abstand der engsten 
Annaherung bei der Sollbeschleunigung des Fahrzeuges, die im letzten Zeitschritt durch die Einrichtung 
KVi bestimmt wurde, ermittelt und die zweite Einrichtiing ATP den zu erwartenden Abstand der engsten 
Annaherung bei einer gegenuber der ersten Einrichtung KP um einen vorab frei vorgebbaren Betrag 
geanderien Sollbeschleunigung ermittelt und durch nachgeordnete Obertragungsglteder aus der Anderung 
des zu erwartenden Abstandes der engsten Annaherung bei der veranderten Sollbeschleunigung eine neue 
Sollbeschleunigung mil einem Abstand bei der engsten Annaherung groBer oder gleich dem Mindestab- 
stand bestimmbar ist und daB eine Einrichtung (1.8) zur Anzeige,ob die Sollbeschleunigung des Fahrzeuges 
innerhalb eines frei vorgebbaren Zulassigkeitsbereiches liegt und ob das Fahrzeug mit der neuen Sollbe- 
schleunigung im Zeitpunkt der engsten Annaherung eine zum Hindernis relative Geschwindigkeit groBer 
als ein frei vorgebbarer Grenzwert hat und somit das Hindernis passiert vorgesehen ist 

21. Vorrichtung nach einem der Anspruche t4 bis 20, dadurch gekennzeichnet daB eine Einrichtung KV2 
mit Einrichtungen (2.K 2.2 und 2.3) vorgesehen ist mit der Einrichtung (2.1 ) zur Ermittlung der Verschiebung 
der Soliposition des Fahrzeuges quer zur Kursrichiung bei einem Ausweichmanover nach links und einem 
Auschweichmanover nach rechts und der EinHchiung (2.2) zur Bestimmung der Gewichtungsfakloren fur 
einen stetigen .Obergang der Fahrzeugsollposition von der urspriinglichen Lage in die verschobene Lagc, 
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wobei die AusgSnge der Einrichtung (2.1 ) zur Ermitllung der Verschiebung der Sollposition des Fahrzeuges . 
nach links odcr nach rechts mit den Eing&ngen der Einrichtung (23) zur Auswahl der Verschtebungsrichtung 
der Sollposition und zur Anzeige» ob die neue Position innerhalb eines vorab frei vorgegebenen Zulassig- 
keitsbereiches liegt, verbunden sind, und daB diese Einrichtung (2.3) sowie die Einrichtung (2.2) mit den dort 
gebildeten Gewichtungsfaktoren Obertragungsglieder zur OberfOhrung der Sollposition des Fahrzeuges in 5 
einem stetigen Obergang von der ursprQnglichen Sollbahn in.eine um die in der Einrichtung (23) festgelegte 
Strecke verschobene Lage und zur Bestimmung des Sollkurswinkels derart ansteuem» daB der Abstand der 
engsten Annaherung grdBer oder gleich dem Mindestabstand wird. 

22. Vorrichtung zur Durchftihrung des Verfahrens nach einem der Anspruche 1 bis 23, dadurch gekenn- 
zeichnet, daB eine Einrichtung ^Pzur Bestimmung der Zeitspanne bis zur engsten Annaherung zwischen 10 
einem Fahrzeug und einem Hindernis sowie dem Abstand und dem Winkel zum Zeitpunkt der engsten 
Annaherung mittels Extrapolation der Fahrzeugsollbahn und der Hindernisbahn ausgehend von den Ein- 
gangssignalen Sdllposition, Sollkurswinkel. Sollgeschwindigkeit. Sollbeschleunigung und vorzugsweise 
SollbahnkrOmmungsradius des Fahrzeuges sowie die Position, den Kurswinkel, die Geschwindigkeit, die 
Beschleunigung und vorzugsweise den Bahnkrummungsradius des Hindernisses oder davon hergeleiteter 15 
SignalgroBen bzw. -daten vorgesehen ist, wobei alle Signale zuvor in vorzugsweise aquidistanten Zeitschrit- 
ten abtastbar und iiber einen Zeitschritt konstatit haltbar sind, und daB eine Sensoreinrichtung zur Ermitt- 
lung der Sollbeschleunigung oder eine Einrichtung B zur Herleitung der Sollbeschleunigung aus der 
sensorisch erfaBbaren aktuellen Sollgeschwindigkeit und der in einem vorausgehenden, vorzugsweise 
letzten Zeitschritt der Vorrichtung verarbeiteten Sollgeschwindigkeit ermittelbar ist, und daB ferner eine 20 
Einrichtung KE zur Feststellung und zum Anzeigen der Kollisionsgefahr in Abhangigkeit der Zeitspanne 
bis zur engsten Annaherung und des Abstandes der engsten Annaherung vorgesehen ist, und daB eine 
Annaherung R4 und /irV4—y4 £75 vorgesehen ist,. mit der Einrichtung KVA zur Oberfuhrung der 

Sollposition des Fahrzeuges in einem sitettgen Obergang bis zum Zeitpunkt der engsten Annaherung in eine . 
um die Differenz zwischen dem Mindestabstand und dem zu erwartenden Abstand der engsten Annaherung 25 
zwischen Fahrzeug und Hindernis in Richtung des Winkels der engsten Annaherung verschobene Lage und 
zur Bestimmung des Sollkurswinkels, und mit der Einrichtung 4 zur Ruckfiih rung der Sollposition des 
Fahrzeuges in einem umgekehrten stetigen Obergang auf die ursprungliche Sollbahn nach dem Zeitpunkt 
der engsten Annaherung und zur Neubestimmung des Sollkurswinkels, wobei mittels der Einrichtung 
ICVA^AUS dxQ. lirsprungiichen Werte fur die Sollposition und den Sollkurswinkel des Fahrzeugs bei 30 
angezeigter Kollisionsgefahr durch die von der Einrichtung KV4 neu bestimmten Werte fur die Sollposi- 
tion und den Sollkurswinkel und nach dem Zeitpunkt der engsten Annaherung durch die von der Einrich- 
tung R 4 neu bestimmten Werte fur die Sollposition und den Sollkurswinkel ersetzbar sind. 
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